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ABSTRACT 


The  problem  of  implementing  a three-state  optimal  control 
law  in  a anti-tank  weapon  system  was  examined.  The  weapon  system 
vjas  represented  by  a detailed  six  degree  of  freedom  simulation. 

The  derivation  of  the  control  law  is  included  along  with 
a four-state  simulation  that  was  used  to  model  the  6D0F  simulation. 

The  procedure  used  to  implement  the  control  law  is  given  in  Chapter  HI, 
and  the  method  of  obtaining  optimal  control  parameters  appears  in 
Appendix  C.  The  question  of  sensitivity  is  also  examined  using  both 
simulations.  Final  conclusions  and  recommendations  appear  in  Chapter  V. 


ACKNOWLEDGEMENTS 


Dr.  Harold  Pastrick,  contract  supervisor,  of  the  U.S.  Army 
Missile  Command,  has  been  most  helpful  with  his  suggestions  and 
demands.  We  would  also  like  to  acknowledge  the  assistance  of 
Dr.  Thomas  Madron  and  his  Research  and  Computer  Services  group  at 
Western  who  have  patiently  answered  our  many  questions  and  requests. 
This  contract,  with  its  security  requirement,  has  posed  special 
problems,  and  we  would  like  to  thank  Dr.  Glenn  Crumb  and  his  assistants 
at  the  Office  of  Grants  and  Contracts  for  their  aid. 

This  report  could  not  have  een  prepared  without  the  help  of 
Debra  Wheeler,  who  not  only  was  most  careful  in  the  typing  of  this 
manuscript,  but  who  was  able  to  spot  and  correct  oversights  on  our 
part . 


Someone  has  to  be  last,  but  we  hope  that  no  affront  is  taken. 
We  would  like  to  especially  thank  our  wives  for  their  patience  and 
understanding  they  showed  during  this  contractual  period  and  the 
preparation  of  this  final  report. 


'1 


CONTENTS 


Chapter  Page 

I.  Introduction. 

1.1  Background 1 

1.2  Implementation  of  the  Control  Law 2 


II.  Implementation  of  the  Six  Degree  of  Freedom  Simulation 
on  the  IBM  370  System. 


2.1  Incompatabl lity  of  IBM  and  CDC  FORTRAN 3 

2.2  Disk  Storage  and  CJS 3 

2.3  Selection  of  Compiler  4 

2.4  Simulation  Simplification  for  Developmental  Work.  ...  4 

2.5  Additional  Capability  Added  4 

2.5.1  Roll,  Yaw  Control 4 

2.5.2  Plotting  Capability 5 

2.6  General  Review  of  the  6DOF  Simulation 5 

2.6.1  Airframe  Model  5 

2.6.2  Rotation 7 

2.6.3  Translation 7 

2.6.4  Aerodynamic  Forces  and  Moments  8 

2.6.5  Target  Model  9 

2.6.6  Guidance  and  Control  Models 10 

2.6.7  Gyroscope  Model 10 

2.6.8  Guidance  Filter  Model 11 

2.6.9  Actuator  Model 11 

III.  Control  Law  Implementation  - Ideal  Case 

3.1  Brief  Summary  of  Control  Law 12 

3.2  General  Outline  of  Approach  14 

3.3  Determination  of  Control  Parameters  y and  6 16 

3.4  6D0F  Simulation  Implementation 17 

3.4.1  Modification  of  Control  Module  Cl 18 

3.4.1a  Implementation  of  the  Control  Law.  ...  18 
3.4.1b  Control  Module  Cl  Listing 18 

3.4.2  Evaluation  of  Control  Gains  GPIT,  GYAW  27 

3.4.3  Control  Parameter  Improvement 27 

3.5  Sensitivity  Analysis 27 

3.5.1  Sensitivity  for  the  Four-State  Simulation.  ...  27 

3.5.2  Sensitivity  with  the  6D0F  Simulation 29 

IV.  Control  Law  Implementation  - Practical  Case 

4.1  Disadvantages  of  the  Three-State  Controller  36 

4.2  A Controller  Using  X,  X 36 

4.3  Implementation  of  the  X,  A,  6 Controller 37 

4.4  Estimation  of  the  Time-to-go 38 


iii 


Page 


V.  Concf^usions  and  Recommendations  for  Future  Study 39 

VI.  Simplified  6D0F  Simulation 40 

References 124 

Appendix 


A.  Optimal  Terminal  Guidance  With  Constraints 

at  Final  Time A-1 

B.  Four-State  Simulation  Listing B-1 

C.  Determination  of  Optimal  Control  Parameters: 

An  Application  of  Mathematical  Programming.  . . C-1 

D.  Hooke-Jeeves  Algorithm  Listing  D-1 

E.  Derivation  of  the  Three-State  Control  Law E-1 


I 


1 


LIST  OF  ILLUSTRATIONS 


Figure  Page 

2.1  Modularization  of  the  6D0F  Simulation 6 

2.2  Block  Diagram  of  Pitch  or  Yaw  Guidance  Channel  7 

2.3  Ideal  Seeker  Characteristics  10 

3.1  Geometry  of  Tactical  Missile  - Target  Position  12 

3.2  Hooke  - Jeeves  Algorithm  for  n = 2 17 

3.3  Original  Feedback  Control  System  19 

3.4  Missile  Roll  Stabilized  Position  18 

3.5  Initial  Implementation  of  the  3-State  Controller  ....  28 

3.6  RZE  vs.  RXE 34 

3.7  THETA  vs.  TIME 35 

4.1  Missile  - Target  Geometry 36 


I 


Table 


LIST  OF  TABLES 


Definition  of  Variables  12 

New  Variables  for  Subroutine  Cl 20 

Performance  for  Various  Initial  Conditions  (Baseline  I)  . . 30 
Performance  for  Various  Initial  Conditions  (Baseline  II).  . 3i 

Performance  Dependence  on  GPIT 

Performance  Dependence  on  y and  32 

6D0F  Simulation  Runs  for  Various  Initial  Conditions  ....  33 


Chapter  I 


INTRODUCTION 


1.1  Background 

Recent  intelligence  suggests  that  Che  impenetrable  nature 
of  heavy  armor  may  be  susceptible  to  missile  attacks  at  a relatively 
high  angle  of  impact,  with  respect  to  the  horizon.  In  many  modes  of 
direct  encounter,  the  target  may  not  be  reachable  with  a body  pitch 
attitude  angle  of  the  proper  magnitude.  There  are  several  possible 
reasons  for  this  condition,  including  lack  of  energy  (fuel),  lack  of 
lime  to  maneuver  into  the  more  desirable  attitude,  or  lack  of  control 
information  by  appropriate  sensors  to  command  the  response.  This 
condition  has  been  recognized  tor  some  time  at  the  Missile  Research 
and  Development  Command,  and  consequently  there  have  been  attempts 
to  modify  trajectory  shapes  by  a variety  of  predetermined  control 
laws.  However,  there  has  been  a certain  lack  of  robustness  in  the 
solutions  obtained  over  the  entire  range  of  conditions  anticipated. 

This  situation  motivated  a search  for  optimal  solutions  to  the  guidance 
problem  and  a study  of  tradeoffs  among  the  suboptimal  candidates  that 
were  deemed  feasible. 

Terminal  guidance  schemes  for  tactical  missiles  may  be  based 
on  a classical  approach,  such  as  a proportional  navigation  and  guidance 
law  [3,4),  or  on  a modern  control  theoretic  approach  [1,5,6].  In  the 
latter,  a control  law  is  derived  in  terms  of  time-varying  feedback 
gains  when  formulated  as  a linear  quadratic  control  problem.  A sub- 
optimal  terminal  guidance  system  for  re-entry  vehicles,  derived  using 
the  modern  approach,  was  the  basis  for  the  initial  work  of  this 
problem. 


Kim  and  Grider  [2]  studied  a suboptimal  terminal  guidance 
system  for  a re-entry  vehicle  by  placing  a constraint  on  the  body 
attitude  angle  at  impact.  Their  problem  was  oriented  to  a long-range, 
high-altitude  mission.  Their  scenario  was  formulated  as  a linear 
quadratic  control  problem  with  certain  key  assumptions.  The  angle  of 
attack  of  the  re-entry  vehicle  was  assumed  to  be  small  and  thus  was 
neglected.  Furthermore,  the  autopilot  response  was  assumed  to  be 
instantaneous,  i.e.,  with  no  lag  time  attributed  to  the  transfer  of 
input  commands  to  output  reaction. 

These  conditions  have  been  studied  in  an  extension  of  their 
earlier  work  where  a formulation  is  given  for  a system  that  has  finite 
time  delay.  In  fact,  the  increase  and  decrease  in  time  delay  has 
interesting  ramifications  on  the  solution.  The  angle-of-attack 
assumption  is  investigated,  and,  although  not  solved  analytically  in 
closed  form,  the  system  is  derived  [9]. 

There  is  more  than  just  a passing  academic  interest  in  this 
problem.  As  suggested  previously,  the  antiarmor  role  of  several  Army 
weapon  systems  very  well  may  be  enhanced  by  this  technique.  The 
reduction  to  a practical  implementation  or  mechanization  is  the  aim 
of  this  contract. 
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1.2  Implementation  of  the  Control  Law 
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In  order  to  investigate  the  problems  arising  from  the  practical 
implementation  of  such  an  optimal  control  law  on  a real  system,  a detailed 
six  degree  of  freedom  (6D0F)  digital  simulation  of  such  a system  was 
needed.  Such  simulations  are  so  complex  that  to  implement  the  control 
law  from  just  a programming  point  of  view  would  require  that  the  simulation 
would  have  to  be  in  modular  form;  otherwise,  the  programming  difficulties 
would  obscure  the  implementation  difficulties.  Such  a simulation  of  a 
semiactive  laser-guided  air-to-ground  missile  was  provided  to  the  authors 
by  Dr.  Harold  L.  Pastrick  of  the  Army  Missile  Command,  the  contract 
supervisor.  Unfortunately,  none  was  available  that  would  work  on  the 
IBM370  system  at  the  University  of  Kentucky  that  would  be  used  - see 
section  2.1  for  a discussion  of  the  considerable  difficulties  encountered. 

The  detailed  6D0F  simulation  would  give  an  accurate  represen- 
tation of  the  real  system  and  how  it  would  respond  with  the  new  controller. 
Although  a simpler  four-state  simulation  would  be  used  as  a guide  in 
implementing  the  control  law,  it  assumed  only  a point  mass  representation 
of  the  missile.  The  6D0F  simulation  had  wind  tunnel  test  data  used  in 
the  calculation  of  aerodynamic  forces  and  moments,  and  could  be  used  to 
examine  performance  under  more  realistic  conditions. 

The  original  work  [2]  assumed  no  lag  in  the  autopilot,  another 
possible  source  of  trouble.  A more  complex  control  law  based  on  a first 
order  autopilot  lag  model  had  been  derived  [9]  and  was  available  tor 
implementation  if  needed.  Perhaps  the  most  crucial  assumption  of  all 
to  be  tested,  was  that  of  no  hard  constraint  on  the  controller  as  is 
present  on  the  missile  in  the  tail  fin  stops.  The  only  constraint  in 
the  formulation  of  the  control  problem  was  a 'soft  constraint*  present 
in  the  cost  function  J to  be  minimized.  Equation  (3,3). 

The  approach  used  was  to  implement  the  control  law  with  the 
set  of  state  variables  given  in  [2]:  missile  attitude  angle  6,  projected 
misslle-to-target  distance  on  ground  and  rate  Yj.  Perfect  knowledge 
of  the  states  were  assumed.  Since  Y^,  Y^  cannot  be  measured,  the  set 
of  state  variables  was  then  altered  to  include  the  line  of  sight 
angle  A and  rate  A,  In  this  setting,  all  variables  were  to  be  assumed 
available  at  first,  and  then  realistic  measurements  from  the  seeker 
for  A, A was  to  be  used,  along  with  a gyro  measured  attitude  angle  0. 

See  section  3.2  for  a more  complete  outline  of  the  approaches  used,  along 
with  other  sections  of  Chapters  III  and  IV. 

Conclusions  and  recommendations  for  future  study  appear  in 

Chapter  V, 
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Chapter  II 


IMPLEMENTATION  OF  THE  6DOF  SIMULATION 
ON  THE  IBM370  SYSTEM 

2.1  Incompat ability  of  the  IBM,  CDC  FORTRAN'S 

One  might  be  inclined  to  think  that  all  FORTRAN'S  are 
comparable,  but  such  is  certainly  not  the  case.  Each  computing 
system,  whether  it  be  that  of  IBM  or  CDC,  has  certain  unique 
features  of  which  a programmer  can  take  advantage.  The  code  of 
the  6D0F  simulation  took  extensive  advantage  of  such  features 
and  made  implementation  on  the  IBM370  system  quite  difficult. 

All  incompatabilities  between  the  two  FORTRAN'S  had  to  be  detected 
and  resolved — a process  which  required  several  months  of  effort. 

The  final  goal  of  the  altering  of  the  FORTRAN  code  was  to  produce 
a simulation  that  would  run  on  the  IBM370  as  well  as  the  CDC6600, 
that  is,  the  code  was  not  to  take  advantage  of  the  special  features 
of  either  system. 

Some  of  the  programming  inconsistencies  were  easy  to 
spot  and  correct.  Among  these  were  the  use  of  '*'  for  titles  in 
FORMAT  statements,  variable  names  that  were  too  long,  restrictions 
on  handling  alphanumeric  character  data,  restrictions  on  combining 
the  initialization  of  data  for  arrays  and  specifying  their  length, 
the  number  of  lines  on  which  a statement  can  be  continued,  restrictions 
on  the  indexing  of  parameters  in  DO  loops. 

Other  programming  incompatabilities  vjere  more  difficult  to 
detect  and  correct.  The  plotting  capability  in  the  simulation  made 
extensive  use  of  in  house  plotting  subroutines  and  had  to  be  bypassed. 

A very  troublesome  programming  practice  was  that  of  not  initializing 
variables  when  their  initial  value  was  to  be  'O'.  The  CDC  machine 
will  zero  out  its  memory  with  the  start  of  any  new  job.  The  IBM 
computer  does  not.  The  'garbage'  in  those  particular  memory  locations 
will  be  used  in  the  executation  phase  without  any  warning  to  the  user. 
The  way  this  problem  was  finally  solved  was  to  run  the  program  with 
a WATFIV  compiler  which  will  flag  uninitialized  variables. 

Some  subroutines  such  as  those  involved  with  linear  inter- 
polation of  one  or  two  variables,  made  such  extensive  use  of  special 
CDC  array  manipulation  features  that  they  had  to  be  rewritten  and, 
consequently,  retested  for  accuracy. 
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2.2  Disk  Storage  and  CJS 

The  simulation  was  of  such  length  that  disk  storage  was 
essential.  Once  the  simulation  was  placed  on  disk,  the  problem  was 
still  how  to  Implement  the  numerous  corrections  decided  upon.  To 
this  end,  it  was  decided  to  use  a new  IBM  editing  creation  called  CJS, 
Conversational  Job  System  which  was  a subset  of  a larger  package 
called  CMS,  Conversational  Monitor  System.  Especially  desirable 
features  Included  were  the  ability  to  search  for  phrases,  to  delete 
or  add  lines,  rearrange  whole  sections  of  code,  to  make  global 
changes  as  well  as  local  ones,  and  to  create  executive  programs  to 
serve  a wide  variety  of  needs. 
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To  reduce  execution  time,  all  subroutines  which  were  to 
remain  unchanged  were  stored  on  disk  in  object  form  to  lessen 
compilation  time. 

2.3  Selection  of  Compiler 

The  WATFIV  FORTRAN  compiler  was  chosen  for  the  initial 
phase  of  the  work  because  of  its  rather  extensive  collection  of 
syntax  error  messages.  Once  the  syntax  errors  were  removed,  the 
G-level  compiler  was  used  because  of  its  speed  in  compiling.  When 
finally  the  point  was  reached  were  code  changes  were  few,  the 
H-level  compiler  was  incorporated  because  it  optimizes  the  execution 
of  the  code.  In  order  to  do  this,  it  does  take  longer  to  compile. 


2.4  Simulation  Simplification  for  Developmental  Work 

For  the  developmental  phase,  a shorter,  less  complex 
simulation  was  desired,  one  that  would  be  less  expensive  to  run. 

The  original  6D0F  simulation  provided  capabilities  that  were  neither 
needed  nor  desired.  A variety  of  seeker  modules,  actuators,  and 
autopilots  were  available.  The  simulation  was  set  up  to  run  Monte 
Carlo  sets  and  to  give  various  statistical  analyses  for  the  results. 
There  was  in  addition  a plotting  capability  which  would  be  quite 
desirable  but  was  unusable  due  to  the  utilization  of  subroutines 
found  only  on  the  CDC  system. 

To  reduce  compilation  and  run  time,  it  was  decided  to 
pare  down  the  simulation  so  that  the  resulting  shorter  form  of  the 
simulation  would  contain  only  the  modules  and  subroutines  necessary 
for  the  development  work.  To  this  end,  some  27  subroutines  were 
deleted.  They  were  C2,  C2I,  NORMAL,  RANNUM,  MCARLO,  AERROR,  TERROR, 
CEPAS,  CEPP,  NORM,  KSTEST,  TABLE,  PPLOT,  XLOC,  G2 , G2I,  S4 , S41,  C5, 
C5I,  RESET,  PL0T4,  S2,  S3,  PL0T2 , PLOTN,  and  SUBLl. 

A listing  of  the  shortened  form  of  the  6D0F  simulation 
appears  in  Chapter  VI. 


2.5  Additional  Capability  Added 


2.5.1  Roll,  Yaw  Control 

Since  the  initial  work  in  [2]  assumed  motion  in  one  plane 
only,  the  capability  of  controlling  roll  and  yaw  motion  was  added. 
The  simulation  already  had  a roll  control  feature,  but  this  had  to 
be  altered  somewhat  when  the  yaw  control  was  added.  The  user  sets 
switch  0PTN3  equal  to  0 or  1,  depending  on  whether  he  wishes  to 
allow  the  missile  to  roll  or  not,  respectively.  If  no  roll  is 
selected,  then  by  setting  another  switch  OPTNYW  to  0 or  1,  he  can 
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allow  the  missile  to  leave  the  pitch  plane  or  force  it  to  fly  in  it. 

The  coding  of  this  alteration  of  subroutine  D2  follows: 

IF  (OPTN3.LE.O.)  GO  TO  45 
IF  (OPTNTW.LE.O)  GO  TO  55 
GO  TO  65 

45  WPD  = CRAD*FMXBA/FMIX 

55  WRD  = (CRAD*FMgBA+(FMIX-FMIY)* 

Vn>*WQ/CRAD)  /FMIZ 

65  WQD  = (CRAD*FMYBA+(FMI2-FMIX)* 

WP*WR/CRAD)/F!1IY 


2.5.2  Plotting  Capability 

The  original  plotting  capability  was  replaced  with  one 
provided  by  Dr.  St.  Clair  which  would  generate  line  printer  plots. 
Any  variable  in  the  C-array  could  be  plotted  against  time,  and  any 
two  variables  in  the  C-array  could  be  plotted  against  each  other. 
Since  the  graphs  are  done  on  the  line  printer,  they  are  rather 
'crude'  in  appearance,  but  they  do  provide  some  insight  into 
how  variables  are  changing  with  respect  to  time. 

The  variables  to  be  plotted  are  stored  on  disk.  Although 
the  plotting  subroutines  that  are  used  on  the  IBfO70  cannot  be  used 
on  the  CDC6600,  any  program  using  a package  comparable  with  the  CDC 
6600  could  be  used  to  read  off  these  stored  variables. 


2.6  General  Review  of  the  6D0F  Simulation 

The  modularization  of  the  6D0F  digital  simulation  of  a 
seraiactive  laser-guided  air-to-ground  missile  is  given  in  Figure  2.1. 

A block  diagram  for  one  channel  (pitch  or  yaw)  is  shown  in  Figure  2.2, 
and  a brief  description  of  the  various  components  follows.  For  a more 
detailed  examination,  refer  to  [11]  and  [12]. 


2.6.1  Airframe  Model 

The  airframe  model  included  translational  and  rotational 
dynamics  and  generation  of  aerodynamic  forces  and  moments.  Airframe 
dynamics  were  simulated  in  6-DOF  with  the  missile  orientation  repre- 
sented by  three  Euler  angles.  Maneuvering  control  was  achieved  by 
means  by  four  surfaces  in  cruciform  configuration  hinged  about  fixed 
stabilizing  fins. 


AUXSUB 


Figure  2.2.  Block  diagram  of  pitch  or  yaw  guidance  channel. 
2.6.2  Rotation 


^X^B  “ ^XA 

(2.1) 

= ^A  ^ (^Y  - 'X^^B^B 

(2.2) 

^Y^  “ ^ZA  ~ ^^Y  ~ ^X^^B^B 

(2.3) 

where  Pg,  Qg,  Rg  are  rotational  rate  components  about  body  axes  X„,  Yj,, 
Zg  respectively;  and  ly  are  moments  of  inertia  about  Xg  and  Yg;  ana 
^XA»  %A>  components  of  aerodynamic  moment  about  the  body  axes. 

By  resolving  body  rotational  rates  into  the  inertial  and 
intermediate  axis  systems,  the  following  equations  for  Euler  angles  are 
obtained: 

®E  (QgCos({)j.  - RgSin4>g)/cosi|;g  (2.4) 

i/^E  = QgSin({>g  + RgCoS(()g  (2.5) 

4>e  = Pg  - 6Esinii)g  . (2.6) 

2.6.3  Translation 

It  is  advantageous  to  express  the  translation  equations  of 
motion  in  terms  of  inertial  axes  giving 


where  m is  the  mass  of  the  missile;  Fy^j  ^ZA  aerodynamic 

forces  in  the  inertial  axes;  and  g is  acceleration  due  to  gravity. 
Aerodynamic  forces  are  obtained  in  inertial  axis  form  by  transforming 
body  axis  components  according  to  the  following  matrix  equation: 


^XA 

^x' 

^YA 

= [T] 

Fy 

.^ZA. 

(2.10) 


where  F^,  Fy,  F^  are  the  body  axis  aerodynamic  force  components.  The 
body-earth  transformation  matrix  has  elements  defined  in  [8] . 


2.6.4  Aerodynamic  Forces  and  Moments 

For  both  missile  models,  aerodynamic  forces  and  moments  are 
expressed  in  terms  of  body  axes.  The  missile  trajectory  is  divided 
into  two  sections;  unguided  flight  before  the  target  laser  spot  is 
visible  (the  preacquisition  phase)  and  the  guided  portion  of  the 
trajectory  after  the  seeker  has  acquired  the  target  spot  (the  post- 
acquisition phase) . 

Aerodynamic  force  and  moment  components  for  both  flight  phases 
are  as  follows: 


Fx  = -'ISSt 

(2.11) 

(2.12) 

■"z  ■ 

(2.13) 

''XA  = 

■ qSD(C|j  + DPjCp/2V) 

(2.14) 

'^A  = 

qS»(C„c5  + OQbS'"” 

(2.15) 

^ZA  = 

’S"<-SCG  * 

(2.16) 

where  q is  the  dynamic  pressure,  S is  a reference  area  (cross-sectional 
area  of  the  missile),  D is  a reference  length  (diameter  of  the  missile), 
and  V is  the  total  speed  of  the  missile  relative  to  the  atmosphere. 
Dynamic  pressure  is  given  by 

q = pV^/2  (2.17) 


where  p is  atmospheric  density  and  is  a function  of  altitude. 

Aerodynamic  coefficients  and  derivatives  referenced  in  Equations 
(2.11)  through  (2.16)  are  obtained  from  wind  tunnel  tests  and  other 
estimates  are  expressed  in  graphical  form  as  functions  of  angle  of  attack, 
Mach  number  and,  during  the  post-acquisition  phase,  control  vane  angles. 
Coefficients  and  derivatives  are  defined  for  both  models  by  differing 
functions  for  the  two  flight  phases.  Details  of  the  coefficients  for 
both  models  are  presented  in  [8]. 


J 


8 


Angle  of  attack  components  (a  and  g)  may  be  defined  by  the  body 
axis  components  of  velocity.  However,  for  digital  computation,  there  is 
some  advantage  in  expressing  a and  g in  terms  of  integral  equations  using 
wind  axis  coordinates.  Thus,  using  equations  for  a and  ^ derived  in  [8] 
and  making  small  angle  approximations,  the  equations  for  angle  of  attack 
components  are: 


“■  ‘■'zb- 

<Nb-  ®%B>'’*''  + '^B-% 

where  the  body  force  components  (F^g,  F^g,  F^g)  include  aerodynamic 
forces  and  gravity  force  resolved  into  body  axis  components. 


2.6.5  Target  Model 


The  target  model  included  target  position  as  a function  of 
time  and  the  calculation  of  missile-target  miss  distance  at  intercept. 
Target  motion  was  specified  deterministically  as  either  constant  acceler- 
ation or  constant  velocity  from  an  initial  starting  point.  However,  the 
effect  of  "jitter"  in  the  designating  laser  beam  direction  was  intro- 
duced by  applying  a random  disturbance  to  the  calculated  target  position. 


Target  to  missile  displacements  are 


AX  = Xj. 

- X 

m 

(2.20) 

AY  = Y 

t 

- Y 

in 

(2.21) 

AZ  = Z^ 

- Z 

m 

(2.22) 

where  X^,  Y^,  are  target  position  coordinates  and  X^,  T , Z are 
missile  position  coordinates.  The  gyro  platform  is  characterized  by 
two  Euler  angles  (Qgi.  '^SI^  which  define  the  orientation  of  the  platform 
axes  relative  to  inertial  axes  parallel  to  X,  Y,  Z.  Target  to  missile 
displacements  in  digital  seeker  axes  are  given  by 


< 

AX 

= [S] 

AY 

AZ 

(2.23) 


where  the  transformation  matrix  [S]  has  elements  as  shown  in  [8]. 


From  the  target  to  missile  displacements  in  seeker  coordinates, 
the  boresight  error  angles  are  defined  as: 


BEPSZ  = tan  ^ (-AZ^/AXg) 


BEPSY 


tan 


(2.24) 


(2.25) 


2.6.6  Guidance  and  Control  Models 


The  guidance  and  control  models  included  the  seeker  detector 
and  gyro,  guidance  filters,  and  vane  actuators.  The  laser  detector  is 
mounted  on  a 2-DOF  gyro-stabilized  platform  in  the  nose  of  the  missile, 
and  the  laser  beam  is  viewed  through  a fixed  lens.  After  the  gyro  has 
been  uncaged  during  the  terminal  homing  phase  of  the  missile  flight, 
gimbal  torquing  signals  are  generated  to  null  the  spot  displacement 
from  the  center  of  the  detector  and  the  resulting  gimbal  angles  and 
rates  relative  to  the  missile  are  used  to  generate  guidance  and  sta- 
bilizing signals  for  input  to  the  guidance  filters.  Detector  output 
is  from  a sample-and-hold  unit  which  operates  at  a fixed  period. 

A proportional  navigation  guidance  scheme  is  employed;  the  guid- 
ance filters  are  lead-lag  networks  in  each  of  the  pitch  and  yaw  channels 
which  serve  to  decouple  the  missile  natural  frequency  in  pitch  and  yaw 
from  the  control  system. 

The  ideal  characteristics  of  the  seeker  transfer  function  are 
sho\m  in  Figure  2.3. 
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Figure  2.3.  Ideal  seeker  characteristics. 


2.6.7  Gyroscope  Model 

For  many  of  the  studies  using  the  digital  simulation,  it  is 
desirable  to  model  a gyro  which  has  no  dynamic  time  constants.  The 
simplest  model  possible  is  one  represented  by  a perfect  integration, 
i.e.,  1/s  in  the  Laplace  notation. 

As  is  well  known  [8],  for  example,  the  differential  equation 
relating  output  axis  motion  to  input  torque  or  input  rate  is  given  by 

J0  + B9  + K0  = -H* 
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I where  J ft- lb/ (rad/sec  ) , B ft-lb/ (rad/sec)  , K ->  ft/rad,  and 

[ H ft-lb/ (rad/sec)  . 

[ 

r 

t 

I 2.6.8  Guidance  Filter  Model 

I 

The  guidance  filter  or  compensation  network  is  of  the  lead- 
lag  type  with  transfer  function  (T3S  + 1)/(t^s  + 1),  where  T3  is  the 
lead  time  constant  and  is  the  lag  time  constant.  The  input  to  the 
I guidance  filter  comes  from  two  sources,  the  sample-and-hold  output  of 

I the  seeker  and  the  damping  network  output. 


I 2.6.9  Actuator  Model 

f A first-order  actuator  was  used  in  the  simulation  with  transfer 

! function  AA/ (s  + AA)  where  AA  is  the  actuator  model  constant.  The  input 

to  the  actuator  is  from  the  guidance  filter,  and  the  output  drives  the 
I.  canards.  The  yaw  control  canards  are  on  a common  shaft,  as  are  the 

I pitch  canards. 

I 

i 

i 

I 

I 
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Chapter  III 


CONTROL  LAW  IMPLEMENTATION  - IDEAL  CASE 
3.1  Brief  Summary  of  Control  Law 

In  the  paper  "Terminal  Guidance  for  Impact  Attitude  Angle 
Constrained  Flight  Trajectories"  [2],  a simplified  model  of  a missile  - 
target  scenario  is  used  to  produce  a three  state  control  law  that  will 
result  in  the  missile  impacting  vertically  on  the  target,  Figure  3.1 
deplicts  the  geometry  of  the  terminal  guidance  phase,  and  Table  3.1 
defines  the  variables  introduced. 
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Figure  3.1.  Geometry  of  Tactical  Missile  - Target  Positions. 
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; Table  3.1.  Definition  of  Variables 

r 

i 

. Variable  Definition 
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Y 


m 


Missile  position  variable  projected  on  the  ground  (ft) 
Target  position  variable  (ft) 

Position  variable  from  missile  to  target  projected  on 
the  ground  (Y^^  = ^t“’'^m) 
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Table  3.1.  Continued 


Variable 

Definition 

Yd 

Time  derivative  of  Y^  (ft/sec) 

2 

Lateral  acceleration  of  the  missile 

(ft/sec  ) 

9 

Body  attitude  angle  of  the  missile 

(deg) 

The  following  set  of  state  variables  was  chosen  for  the 
modeling  process. 


(3.1) 


Under  the  following  assumptions; 

1)  the  angle  of  attack  is  small  and  can  thus  be  neglected,  and 

2)  the  autopilot  has  zero  lag, 

u = Ci(t)Yd  + C2(t)Yd  + C3(t)e  (3.2) 

a control  law  of  the  form  can  be  obtained  which  will  minimize  the 
performance  index 


J = Y,^(t,)  + Y6^(tf)  + e/^fu‘'(t)dt  (3.3) 

U 1 i Lq 

where  the  state  variables  are  subject  to  the  following  dynamics: 

Yd  = Yd  (3.4) 

Yj  = -A^  cos  6 (3.5) 

= -WjAj^  + Kju  (3.6) 

6 = K,  u . (3.7) 


Yd  = Yd 


Aj^  = -WjAj^  + Kju 


6 = Kg  u . (3.7) 

Performance  is  considered  to  be  acceptable  when  the  following  constraints 
are  satisfied: 


|Yd(tf)  i 1 5 feet 

I 0 ( t j. ) I ^ 5 degrees  . 


(3.8) 

(3.9) 


The  time  varying  coefficients  appearing  in  the  control 
law  are  given  by : 

2 2 

Cl  = [-Bg(tf-t)  - gyK^  (tf-t)  /2]/A  (3.10) 

2 2 3 

C2  = [-iig(tf-t)  - gyKg  (tf-t)  /2]/A  (3,11) 

2 3 

C3  = [-SyKa  + yKgg  (tf-t)  /6]/A  (3.12) 

where 


(b  = COS0  in  the  linearized  form) 


(3.13) 


an  Q 2 2 2 3 

A H B + yBK^  (tf-t)  + 3g  (tf-t)  /3  + 

22  4 (3.14) 

yg  K3  (tf-t)  /12, 

t = time,  tf  = time  of  impact. 

A derivation  of  this  control  law  is  given  in  Appendix  E, 

The  assumption  of  no  lag  in  the  autopilot  has  been  removed 
by  Pastrick  and  York,  "Optimal  Terminal  Guidance  with  Constraints  at 
Final  Time"  [9],  This  work  discusses  a control  law  more  general  in 
nature  which  allows  the  control  law  of  [2]  as  a limiting  case. 
Appendix  A contains  a detailed  examination  of  this  more  realistic, 
and  consequently,  more  complex  control  law. 


3.2  General  Outline  of  Approach 

A simplified  simulation  using  the  dynamics  as  modeled  in 
section  3,2  was  developed  (Appendix  R).  Whenever  feasable,  new  ideas 
were  tried  out  on  the  simplified  simulation  first  to  test  their  merit. 
This  approach  is  not  only  philosophically  sound,  but  there  was  a very 
practical  reason  for  it  as  well — money,  or  rather  the  lack  thereof. 

The  large  scale  simulation  received  from  Redstone  Arsenal  required 
large  amounts  of  memory  and  was  rather  expensive  to  run  (@  $20  for  a 
complete  flight). 

The  smaller  four  state  simulation  was  made  to  resemble  the 
large  6D0F  one  as  closely  as  possible.  The  original  constant  velocity 
was  replaced  with  a time  varying  velocity  profile  taken  from  a 6D0F 
simulation  run.  The  parameters  Kf,  K^,  Wfthat  appear  in  the  four 
state  dynamics  were  re-examined  and  evaluated  to  be  sure  that  they 
reflected  the  dynamics  of  the  actual  weapon  system.  It  was  found  that 
the  parameter  values  given  In  [2]  of  a typical  tactical  missile  did 
reflect  the  dynamics  in  our  case  as  well.  One  discrepancy  was  that 
our  autopilot  lag  was  more  accurately  represented  by 

w *=  9.8  (3.15) 


instead  of 


(3.16) 


but  it  was  decided  to  use  the  smaller  value  in  the  developmental 
work  as  this  represents  more  lag  in  autopilot.  Since  our  small 
scale  simulation  ignores  aerodynamic  forces  and  moments,  it  was 
felt  that  this  increased  lag  might  make  our  simple  simulation 
even  more  representative  of  the  actual  system. 

The  6D0F  simulation  was  altered  as  well.  Since  the 
initial  work  in  [2]  assumed  flight  in  one  plane  only,  it  was 
decided  to  first  try  to  implement  just  the  pitch  control,  and 
then  later  a yaw  control.  Consequently,  the  roll  and  yaw  control 
parameters  were  set  so  that  the  missile  was  allowed  to  neither 
roll  or  yaw.  Once  the  control  law  was  properly  implemented  in  the 
pitch  channel,  then  symmetry  would  suggest  that  it  could  be  implemented 
in  the  same  manner  in  the  yaw  channel. 

Once  the  control  law  was  performing  properly  with  the  four 
state  simulation,  then  it  would  be  used  on  the  6D0F  simulation.  The 
approach  used  in  implementing  the  control  law  was  to  assume  that  all 
of  the  states  Yj,  Yj,  and  6 were  knovm  and  could  be  measured  exactly, 
and  that  it  was  possible  to  generate  the  time  varying  coefficie.  ts 
Cl,  C2,  C3  without  error.  It  was  felt  that  for  the  initial  implemen- 
tation that  it  was  better  to  leave  the  choice  of  states  as  given  in 
[2],  although  there  isin  fact  no  way  to  measure  the  range  and  range 
rate  states  of  Yj  and  Y^j.  For  this  reason,  this  implementation  is 
referred  to  as  the  ideal  case.  For  the  practical  case,  an  alternative 
set  of  state  variables  was  used. 

The  control  parameter  values  appearing  in  [2]  were  optimized 
for  a vertical  Impact  angle,  but  the  initial  geometry  was  that  of  a 
forty-five  degree  triangle  (10,000'  from  the  target  - 10,000'  up). 

When  using  their  control  parameter  values  of 

Y = 3823  and  0 = 6.94E-04  (3.17) 

with  our  low  profile  trajectory  (200'  x 2600'),  the  missile  in  the 
simple  simulation  would  overfly  the  target.  The  same  type  of  trajectory 
was  obtained  on  the  6D0F  simulation.  Basically,  the  trouble  seemed 
to  be  that  the  missile  could  not  turn  in  the  time  allowed.  The  presence 
of  aerodynamic  forces  and  moments  made  this  problem  even  more  acute. 

It  was  decided  to  first  try  to  achieve  an  attitude  angle  that 
would  be  less  demanding  on  the  control  system,  such  as 

0(tf)  = 45  degrees.  (3.18) 

Appendix  A shows  how  it  is  possible  to  use  the  same  control  law  to 
achieve  an  arbitrary  angle.  These  initial  runs  also  suggested  that 
the  geometry  for  the  terminal  guidance  phase  needed  to  be  altered 
to  allow  more  height  with  which  to  work.  Thus,  it  was  decided  that 
the  trajectory  would  need  to  consist  of  two  phases:  a pre-programmed 
pitch  maneuver  to  gain  altitude  followed  by  a terminal  guidance  phase. 
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Initial  conditions  for  the  terminal  guidance  phase  were 
chosen  to  be: 

= 1000',  Yj  = 5000',  e = 85°  . (3.19) 

The  same  assumptions  were  made  as  in  [2]  of  no  angle  of  attack  and  no 
lag  in  the  autopilot.  It  was  decided  to  implement  the  3-state  controller 
because  of  its  relatively  simple  form.  Should  lag  become  a problem, 
the  4-state  controller  discussed  in  Appendix  A could  be  tried.  The 
basic  problem  then  was  to  find  the  optimal  values  of  the  two  control 
parameters  y and  8 that  will  minimize  the  cost  functional  J given  as 
Equation  (3.3).  This  problem  was  solved  using  the  Hooke  - Jeeves 
Algorithm  as  discussed  in  section  3. 3. 

With  the  following  parameter  values, 

Y = 5525.51  and  B = . 19E-06  (3.20) 

a miss  distance  of  3.3'  was  achieved  with  an  attitude  angle  at  impact 
of  45.27°.  With  these  control  parameter  values,  the  control  law  was 
used  with  the  6D0F  simulation.  Section  3.4  discusses  how  the  control 
law  was  implemented.  In  summary,  though,  a miss  distance  of  18  feet 
and  an  attitude  angle  of  37  degrees  was  obtained  before  efforts  were 
made  to  improve  on  the  control  parameter  values,  see  section  3.4. 

Finally,  performance  sensitivity  to  initial  conditions  is  discussed 
in  section  3.5. 


3.3  Determination  of  Control  Parameters  y and  B 

Two  control  parameters  appear  in  the  cost  functional  to  be 

mininized : 

J = Y^^tp  + Y[9(tf)-45]^  + B/Jfu2(t)dt  . (3.21) 

Tlie  problem  was  to  determine  optimal  values  for  y and  B so  that  the 
following  success  criteria  could  be  achieved: 

I'^d^tf)  ! 1 5 feet  (3.22) 

|6(tf)-45  I ^ 5 degrees  . (3.23) 

The  approach  used  to  solve  this  problem  was  to  view  it  as 
the  mathematical  programming  problem  of  minimizing 

F(,,B)  = Y^^(tj)  + [9(t^)-45]2  (3.24) 

where  the  function  evaluation  was  achieved  through  a computer  run  of 
the  four-state  simulation  program  with  specified  values  for  y and  B. 
(see  Appendix  C for  a discussion  of  mathematical  programming  in 
general  and  this  problem  in  particular). 
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To  make  the  mathematical  programming  problem  mathematically 
feasible,  it  was  assumed  that  F(y,3)  varied  in  a continuous  manner  with 
respect  to  its  two  arguments.  Since  F(y,6)  could  not  be  expressed 
in  any  closed  form,  there  was  no  derivative  information  available. 

After  some  thought  it  was  decided  to  use  the  Hooke  - Jeeves  Algorithm 
to  tackle  this  problem  as  it  is  rather  straight  forward,  has  almost 
guaranteed  convergence,  and  was  readily  available. 

This  particular  algorithm  will  make  two  exploratory  search 
moves,  one  in  each  coordinate  direction,  to  reduce  F(y,6),  and  then 
will  follow  this  with  a pattern  search  (in  the  direction  of  the 
diagonal) . 


Figure  3.2.  Hooke  - Jeeves  Algorithm  for  n = 2 


Using  this  algorithm,  the  optimal  control  parameter  values 
were  found  to  be 


Y = 5525.508  e = 190E-06 

which  yielded  the  following  results: 

Yjj(tf)  = 3.3'  and 


e(t^)  = 45.27  . 


(3.25) 


(3.26) 


3.4  6D0F  Simulation  Implementation 


The  first  task  in  implementing  the  three-state  optimal  control 
law  was  to  modify  the  control  module  Cl.  This  modification  is  given 
in  section  3.4.1. 

The  second  task  was  to  evaluate  the  two  gains  GPIT,  GYAW 
that  appear  in  the  control  module,  see  section  3.4.2. 


17 


The  last  task  was  to  improve  upon  the  values  of  y and  3 
given  by  the  Hooke  - Jeeves  Algorithm  working  with  the  four-state 
simulation  which  was  being  used  to  approximate  the  6D0F  simulation. 
This  improvement  is  discussed  in  section  3.4.3. 


3.4.1  Modification  of  Control  Module  Cl 


3.4.1a.  Implementation  of  the  Control  Law 

Figure  3.3  gives  the  original  feedback  control  system 
based  on  proportional  navigation.  As  discussed  in  section  3.1, 
it  was  decided  to  initially  control  pitch  motion  only.  The  roll 
stabilization  channel  was  left  in  tact,  as  was  the  cross  coupling 
of  the  pitch  and  yaw  control  channels.  This  cross  coupling  is 
necessary  since  this  particular  missile  when  it  is  roll  stabilized 
flies  with  the  following  tail  fin  configuration: 


Figure  3.4.  Missile  Roll  Stabilized  Position 


All  four  tail  fins  are  required  to  execute  a pitch  maneuver,  as 
would  also  be  true  for  a yaw  or  roll  maneuver. 

The  Initial  command  signal  to  the  tail  fin  occurs  at  the 
first  summation  in  the  pitch  (upward)  and  yaw  (lower)  control 
channels.  This  signal  is  the  difference  between  the  commanded 
attitude  angle  and  the  sensed  attitude  angle  (the  feedback  signal). 

The  new  commanded  attitude  angle  was  given  by  the  control  law 

u = Ci(t)Y^  + C2(t)'5'd  + C3(t)0  . (3.27) 

The  guidance  filters  in  the  pitch  and  yaw  channels  were  replaced  by 
gains  GPIT  and  GYAW  for  the  initial  implementation.  The  new  autopilot 
is  given  in  Figure  3.5. 


3.4.1b.  Control  Module  Cl  Listing 


The  new  variables  that  have  been  introduced  are  given  in 

Table  3.2 
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Feedback  Control  System 


Table  3.2.  New  Variables  for  Subroutine  Cl 


Name 

Symbol 

Location  in 

C Array 

Definition 

BETA 

B 

2917 

Control  parameter 

BDELTC(I) 

'^ci 

856 

Commanded  tail  fin  position,  i = 1,2, 3,4 

BJJ 

881 

Pitch  signal  after  coupling 

BJS 

537 

Pitch  signal  before  coupling 

BKK 

882 

Yaw  signal  after  coupling 

BKS 

545 

Yaw  signal  before  coupling 

BJJSSS 

987 

Pitch  signal  before  limiter 

BKKSSS 

988 

Yaw  signal  before  limiter 

BTHT 

350 

Attitude  pitch  angle  (measured  from  horizon) 

BXX 

Roll  signal  before  network 

BXXSSS 

989 

Roll  signal  after  limiter 

CTHTA(T) 

c (t) 

3 

Control  law  coefficient  for  0 

CXREL(T) 

c (t) 

1 

Control  law  coefficient  for  Y 

d 

CXRELD(T) 

c (t) 

2 

Control  law  coefficient  for  Y 

d 

DELTA(T) 

A 

Denominator  for  control  coefficients 

G 

8 

-bK^/w^ 

GAMMA 

Y 

2916 

Control  parameter 

GRIT 

2921 

Gain  in  pitch  channel 

GYAW 

2922 

Gain  in  yaw  channel 

KA 

K 

a 

2918 

Proportionality  constant  appearing  in 
dynamics 

K1 

’^1 

2919 

Constant  appearing  in  autopilot  lag  model 

T 

t 

2000 

Time 

TGOX 

Estimate  of  time-to-go  in  x direction 

TGOY 

Estimate  of  tlme-to-go  in  z direction 
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Table  3.2.  Continued 


Name 

Symbol 

Location  in 

C Array 

Description 

TGO 

Min  (TGOX,  TGOY) 

TF 

2906 

Estimate  of  time  of  impact 

W1 

'^l 

2920 

Autopilot  lag  constant 

XREl. 

"d 

2904 

Relative  x-direction  missile  - target 
position  (projected  on  the  ground) 

XRELD 

"d 

2905 

Time  derivative  of  XREL 

YREL 

2902 

Relative  y-direction  missile  - target 
position  (projected  on  the  ground) 

YRELD 

2903 

Time  derivative  of  YREL 
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COMMON  C(38j0)  ,GRAPH(300,4) 
DIMENSION  BDELTC(4 ) , VAR( 101  ) 


C 

C*»INPUT  DATA 


EQUIVALENCE 

(C( 

860) ,TDY 

) 

EQUIVALENCE 

(C( 

861 ) ,GBIAS 

) 

EQUIVALENCE 

(C( 

862) ,GN 

) 

EQUIVALENCE 

(C( 

363) ,WN2 

) 

EQUIVALENCE 

(C( 

864) ,WN1 

) 

EQUIVALENCE 

(C( 

866) ,WL 

) 

EQUIVALENCE 

(C( 

866) ,WLXX1 

) 

EQUIVALENCE 

(C( 

867 ) ,WLXX2 

) 

EQUIVALENCE 

(C( 

868) ,WLJK1 

) 

EQUIVALENCE 

(C( 

869) ,WLJK2 

) 

EQUIVALENCE 

(C( 

870) ,HJK 

) 

EQUIVALENCE 

(C( 

871  ) ,WXX 

) 

EQUIVALENCE 

(C( 

872) ,DXX 

) 

EQUIVALENCE 

(C( 

873) ,WJK 

) 

EQUIVALENCE 

(C( 

874) ,DJK 

) 

EQUIVALENCE 

(C( 

875) ,GXX 

) 

EQUIVALENCE 

(C( 

876) ,GJK 

) 

EQUIVriLENCE 

(C( 

877) , RES 

) 

EQUIVALENCE 

(C( 

878) ,QDN 

) 

EQUIVALENCE 

vC( 

879) ,QUP 

) 

EQUIVALENCE 

(C( 

890)  ,HXX 

) 

EQUIVALENCE 

(C( 

892) ,QBIAS 

) 

EQUIVALENCE 

(C( 

893)  ,RBIAS 

) 

EQUIVALENCE 

(C( 

899) ,0PTC1 

) 

EQUIVALENCE 

(C( 

947  ) ,GNS 

) 

EQUIVALENCE 

(C( 

948) ,WS1 

) 

EQUIVALENCE 

r 

(C( 

949  ) ,WS2 

) 

C*»INPUTS  FROM  OTHER  ; 

MODULES 

EQUIVALENCE 

(C( 

77)  ,SPliI 

EQUIVALENCE 

(C( 

87)  ,STHT 

EQUIVALENCE 

ICC 

97)  ,SPSI 

EQUIVALENCE 

353) ,BPH1 

) 

EQUIVALENCE 

(C( 

354) ,BTH2 

) 

EQUIVALENCE 

(C( 

355) ,BPS1 

) 

EQUIVALENCE 

(C( 

403) ,WLAMQ 

) 

EQUIVALENCE 

(C( 

407 ) ,WLAMR 

) 

EQUIVALENCE 

(C( 

461  ) ,CAGE 

) 

EQUIVALENCE 

(C( 

462) ,TKRZ 

) 

EQUIVALENCE 

(C( 

463) ,TKRY 

) 

EQUIVALENCE 

(C( 1233) ,BDR 

) 

EQUIVALENCE 

(C(1747) ,WR 

) 

EQUIVALENCE 

(C( 1 743) ,WQ 

) 

EQUIVALENCE 

(C( 1739) ,WP 

) 

C 

C^INPUTS  FROM  MAIN  PROGRAM 


EQUIVALENCE  (C(2000)  ,T  ) 

C 

C»»  STATE  VARIABLE  OUTPUTS 

EQUIVALENCE  (C(  800),wLQSDD) 
EQUIVALENCE  (C(  803)>LQSP  ) 
EQUIVALENCE  (C(  804),WLQSD  ) 
EQUIVALENCE  (C(  807),WLQS  ) 

EQUIVALENCE  (C(  808),WLQSSD) 
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r — 

EQUIVALENCE  (C(  BID.WLQSS  ) 
EQUIVALENCE  (C(  812),WLRSDD) 
EQUIVALENCE  (C(  815),WLRSP  ) 
EQUIVALENCE  C(  8l6),WLRSD  ) 
EQUIVALENCE  ,Z(.  819),WLRS  ) 

I EQUIVALENCE  (C(  820),WLRSSD) 


EQUIVALENCE  (C(  823),WLRSS  ) 

EQUIVALENCE  (C(  324),BLQSSD) 

EQUIVALENCE  (C(  827),BLQSS  ) 

EQUIVALENCE  (C(  828),BLRSSD) 

EQUIVALENCE  (C(  831),BLRSS  ) 

EQUIVALENCE  (C(  832),BJJSDD) 

EQUIVALENCE  (C(  835),BJJSP  ) 

EQUIVALENCE  (C(  836),BJJSD  ) 

EQUIVALENCE  (C(  839),BJJS  ) 

EQUIVALENCE  (C(  8^0),BKKSDD) 

EQUIVALENCE  (Ct  843),BKKSP  ) 

EQUIVALENCE  (C(  844),BKKSD  ) 

EQUIVALENCE  (C(  847),BKKS  ) 

EQUIVALENCE  (C(  848),BXXSDD) 

EQUIVALENCE  (C(  851),BXXSP  ) 

EQUIVALENCE  (C(  852),BXXSD  ) 

EQUIVALENCE  (C(  855),BXXS  ) 

EQUIVALENCE  (C(  931),BJ3SD  ),  (C(  934), BUSS  ) 

EQUIVALENCE  (C(  935),BKSSD  ),  (C(  938),BKSS  ) 

EQUIVALENCE  (C(  950),SNP2  ),  (C(  953),SNP1  ),(C(  956),SNP0  ) 

EQUIVALENCE  (C(  957),SNQ2  ),  (C(  960),SNQ1  ),(C(  963),SM30  ) 

EQUIVALENCE  (C(  964),SNR2  ),  (C(  967),SNR1  ),(C(  970),SNR0  ) 

EQUIVALENCE  (C(  971),BPC2  ),  (C(  974),BPC1  ),(C(  977),BPC0  ) 

EQUIVALENCE  ( C ( 903 ) , H 1 3P ) , ( C( 904 ) , H 1 3M ) 

EQUIVALENCE  (C(905) ,H24P) , (C(906) ,H24M) 

EQUIVALENCE  (C(907) .CDRFTI ) , (C(908) ,CDRFT2) 

EQUIVALENCE  ( C ( 9 09 ) , CDKFTY ) 

EQUIVALENCE  (C{ 984 ) , CDRFTX) 

EQUIVALENCE  ( C ( 1 67 6 ) , ANGX ) 

EQUIVALENCE  ( C ( 97 8 ) , BDRFTD ) , (C(981 ) ,BDRFT) 

EQUIVALENCE  (C(985) ,NLMT1) , ( C ( 986 ) , NLMT2 ) 

EQUIVALENCE  (C(987 ) .BJJSSS) , {C(988) .BKKSSS) 

EQUIVALENCE  ( C ( 9 89 ) , BXXSSS ) 

EQUIVALENCE  (C(990) ,BJJSSL) , (C(991 ) .BKKSSL) 

EQUIVALENCE  (C(b30) ,BJSDD) , (C(534) , B JSD ) , ( C ( 5 37 ) , BJS ) 
EQUIVALENCE  (C(638) ,BKSDD) , (C(542) ,BKSD) , ( C( 545 ) , BKS ) 
EQUIVALENCE  (C(546) ,BXSDD) ,(C(550) ,BXSD) , ( C( 553 ) , BXS ) 
EQUIVALENCE  ( C ( 5 33 ) , C JSD ) , ( C( 54 1 ) ,CKSD) ,(C(549) ,CXSD) 
EQUIVALENCE  (C(942),WL2) 

EQUIVALENCl  (C(943),DJ2) 

EQUIVALENCE  (C(944),WJ2) 

EQUIVALENCE  (C(945)  ,DX2) 

EQUIVALENCt  (C(946),WX2) 

EQUIVALENCE  ( C ( 2 965 ) , VA H ( 1 ) ) 

C 

C* “OUTPUTS 

EQUIVALENCE  (C(  856 ) , BDELTC ( 1 ) ) 

C 

CM*OTHER  OUTPUTS 

EQUIVALENCE  (C(  880),BPHIS  ) 

EQUIVALENCE  ( C ( 5 1 8 ) , B 1 3SS ) 

EQUIVALENCE  ( C ( 5 1 9 ) , B24SS ) 

EQUIVALENCE  (C(  881), BJJ  ) 

EQUIVALENCE  (C(  882), BKK  ) 


EQUIVALENCE  (C(  d83),BXXSS  ) 

EQUIVALENCE  (C(  ) 

EQUIVALENCE  (C(  8d5),BKKSS  ) 

EQUIVALENCE  (C(  885),BTHTS  ) 

EQUIVALENCE  (C(  d87),BPSIS  ) 

C*»ADDITIONAL  INPUT  FOR  NEW  CONTROL  LAW 
EQUIVALENCE  (C(2000),T  ) 

EQUIVALENCE  (C(  350),BTHT  ) 

EQUIVALENCE  (C(  3d1),BPSI  ) 

EQUIVALENCE  (C(1615),RXE  ) 

EQUIVALENCE  (C(1603),VXE  ) 

EwUIVALENCE  (C(1619),RYE  ) 

EQUIVALENCE  (C(1623),R2E  ) 

EQUIVALENCE  (C(1611),VZE  ) 

EQUIVALENCE  (C(1607),VYE  ) 

EQUIVALENCE  ( C ( 1 65 1 ) , RTXE  ) 

EQUIVALENCE  (C(1660),VTXE  ) 

EQUIVALENCE  ( C( 1 655 ) , RTYE  ) 

EQUIVALENCE  (C(1661),VTYE  ) 

EQUIVALENCE  ( C( 29 1 6 ) , GAMMA ) 

EQUIVALENCE  ( C (291 7 ) , BETA ) 

EQUIVALENCE  (C(2918),KA) 

EQUIVALENCE  (C(2919),K1) 

EQUIVALENCE  (C(2920),W1) 

EQUIVALENCE  ( C ( 292 1 ) , GPIT ) 

EQUIVALENCE  ( C(2922) ,GYAW) 

C»»ADDITIONAL  OUTPUTS 

EQUIVALENCE  ( C ( 2904 ) , XREL  ) 

EQUIVALENCE  { C(2905 ) , XRELD  ) 

EQUIVALENCE  ( C( 2902 ) , YREL  ) 

EQUIVALENCE  ( C( 2903 ) , YRELD  ) 

EQUI VALENCE(C(2906)  , TF ) 

C 

REAL  KA,K1 
DATA  B/.7071/ 

DATA  PID2/1 . 5/0796/ 

C 

DELTA!  T)  = BETA*»24.GAMMA»BETA*KA*»2»(TF-T)  + BETA»G»»2*(TF-T)»»3/3.+ 
(GAMMA*G**2*KA»*2*(TF-T)»»4 )/12. 

CTH.^A!  r)  = (-BETA»GAMMA*KA  + (GAMMA*KA»G«»2*(TF-T)»»3)/6.  )/DELTA(T) 
CXRi:.L(T)  = (-BETA»G*(TF-T)-(G»GAMMA*KA»»2»{TF-T)»»2)/2.  )/DELTA(T) 
CXR£LD(T)= (-BETA»G*(TF-T )*»2-G»GAMMA»KA**2*(TF-T)*»3/2. )/DELTA(T) 
C 

C»»GUIDANCE  SIGNAL  SHAPING 
C»»GUIDANCE  S/.ITCHING 
WLQSD  : WLQSP 
WLRSD  : WLRSP 

WLqSDD  = WN2*{ WN2»(WLAMQ  - WLQS)  - 2.*WLQ3D) 

WLHSDD  = WN2»(«N2»(WLAMR  - WLRS)  - 2.»WLRSD) 

WQC  : GN»(WLQSD/WL  + WLQS)  + QBIAS  + GBIAS 
WRC  = GN*(WLR3U/WL+WLRS)  + RBIAS 
IF  (TKRZ.GT.O.  .AND.  T.GT.TDY)  GO  TO  4 
W LqSDD  = 0 . 

«QC  = QBIAS  + GBIrtS  + QDN 

IF(CAGE  .GT.  0.  .AND.  T.GT.  TDY ) WQC  = WLAMQ  QBIAS  + GBIAS 
4 IF  (TKRY  .GT.  0. ) GO  TO  5 
WLHSDD  = 0. 

WRC  = RBIAS 


IFCCAGE  .GT.  0.)  WRC  = WLAMR  + RBIAS 


5 CONTINUE 


o o 


WLgSSD  = WN1*(WQC  - WLQSS) 

WLRSSD  = Wrn*(WRC  - WLRSS) 

IFCWNI  .GT.  0. ) GO  TO  3 
WLOSS  = WQC 
kJLRSS  : WRC 
3 BLUSSD  = WLgSG 
BLRSSD  = WLRSS 

*»RATt  GYRO  DYNAMICS  AND  LIMITING 
BDKFTD=(CDRFT1»ANGX+CDRFT2) 

BTHTS=-BTH2+BDRFT 
BPSIS=-BPS1+CDRFTY»BDRFT 
BPHIS=-BPH 1+CDRFTX»BDRFT 

BPHISD  = WP  - (wg*COSD(-BPHl  ) -WR»SIND ( -BPH 1) ) 

* *SIND(-BPS1 )/C0SD(-BP31) 

BPriS  = BPHISD  / WLXX2  + BPHIS 
6 IFCGNS  .LE.  0. ) GO  TO  8 

SNP2  = WS1*WS2»(GNS»SPHI-SNP0)  - ( WS 1 +WS2 ) »SNP 1 
SNQ2  = WS1*WS2*(GNS»STHT-SNgO)  - ( WS 1 +WS2 ) *SNg 1 
SNR2  = WS1*WS2»(GNS»SPSI-SNR0)  - ( WS 1 +WS2 ) »SNR 1 
BPHS  = BPHS  -SNPl 
BTHTS  = BTHTS  - SNOT 
BPSIS  = BPSIS  - SNR1 

8 CONTINUE 
BXX  = BPHS 
BTSS  = BTHTS 
BP3S  = BPSIS 

C»«»*»SP£CIAL  CASE  - PROGRAMMED  FLIGHT 
IF(0PTC1  .LE.  0. ) GO  TO  9 
BLgSSD  = gBIAS 
BLRSSD  = 0. 

BDC  = 0. 

BT  = 0. 

BP  = 0. 

IFd’.GE.  1 .0000  .AND.  T . LE  . 3 • 2000 ) BDC=  5. 
IF(T.GE.A.2  .AND.  T . LE . 6 . 4000 ) BT=  5. 
IF(T.GE.7.6000  .AND.  T. LE . 9 . 9000 ) BDC=-b . 
IFCT.GE. 1 1 .000  .AND.  T . LE . 1 3 • 1 00 ) BP=-5 . 

IFCT.GE. 15.200  .AND.  T . LE . 1 7 . 300 ) BDC = 5. 
IF(T.GE. 18. 320  .AND.  T . LE . 20 . 560 ) BT  = 5. 
IF{T.GE.21 .545  .AND.  T . LE . 23 . 675 ) BDC=-5 . 
IFCT.GE. 24. 770  .AND.  T . LE . 26 . 9 1 0 ) BP=-5 . 
C(520)=-BPC0+BP-BT 

BPC2=18.  18^*20. 57*(BDC-BPC0)-(  18.  1 8+20 . 57  ) *BPC  1 
BXX  = BXX  + BPCO 
BTSS=BTSS-BT 
BPSS=BPSS-BP 
C 
C 

9 CONTINUE 

C*»»NEW  OPTIMAL  CONTROL  FOR  PITCH,  YAW  SIGNALS 
G=-B»K1/W1 
XR£L=RTXE-RXE 
YREL=RTyE-RYE 
XfiELD=VTXE-VXE 
YRELD=VTYE-VYE 
C»»»»EST1MATE  OF  TIME-TO-GO 
TGOX=ABS(XREL/XRELD) 

77  TG0Z=AB3(RZE/VZE) 

88  CONTINUE 
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TGO=  AMINKTGOX.TGOZ) 

TF=T+TGO 

BTHTR=BTHT/57. 29578 

BJ3=CTHTA(T)*(PID2+BTHTR)+CXREL(T)»XREL+CXRELD(T)*XRELD 

BJS=-BJS 

BKS=0. 

BJJ=BKS-BJ3 

BKK=-BKS-BJS 

BJJS33=GPIT»BJJ 

BKKSSS=GYAW»BKK 


C»»GUIDANCE  SIGNAL  3HAPING  AND  LIMITING 
BXXSD  = BXXSP 

BXXSDD  = WXX*(WXX*(BXX  - BXXS)  - 2 . *DXX*BXXSD ) 

BX3D=CXSD 

BXXSS=GXX*( (BXXSDD+(WLXX1+WLXX2)*BXXSD)/(WLXX1»WLXX2)+BXXS) 
BXXSS3=BXS 
C»*»SIGNAL  LIMITING 
10  BJJSSL=BJJSSS 
BKKSSL=BKKSSS 

IF(BJJSSL.GT.H13P)BJJ3SL=H 13P 

IF( BJJSSL. LT. H13M) BJJSSL=H 13M 

IF(  Bl<K3SL.GT.H2^P  )BKKSSL  = H24P 

IF(BKK3SL.LT.H24M)BKK3SL=H24M 

B13SS=BJJ3SL 

B24SS=BKKSSL 


C»»COMMANDS  TO  ACTUATORS 

BDELTC( 1 )=B13SS+BXXSSS 

BDELTC(2 )=B24SS+BXXSSS 

BUELTC(3)=B13SS-BXXSSS 

BDELTC(4 )=B24SS-DXXSSS 

RETURN 

END 
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3. A. 2 Evaluation  of  Control  Gains  GPIT,  GYAW 


f 


Two  new  constants,  GPIT  and  GYAW,  the  gains  in  the  pitch 
and  yaw  control  channels,  v;ere  introduced  in  the  control  module  Cl 
to  regulate  the  amplitude  of  the  tail  fin  command  signal.  As  can 
be  seen  from  Figure  3.5,  the  signal  is  fed  through  a limiter  after 
the  multiplication  by  the  gain. 

By  working  with  four-state  simulation,  optimal  values 
were  obtained  for  the  control  parameters,  y and  6 (see  section  3.3). 
Under  the  assumption  that  the  four-state  simulation  approximated  the 
6D0F  simulation,  it  should  be  possible  to  obtain  a reasonable  miss 
distance  and  impact  angle  with  the  more  complex  simulation  by  using 
the  predetermined  optimal  values  of  the  control  parameters.  Several 
runs  were  made  with  varying  values  of  the  gains  GPIT  and  GYAW.  The 
amplitude  of  the  control  signal  had  to  be  such  that  the  tall  fins 
were  not  at  the  stops  throughout  most  of  the  flight,  but  would  be 
hard  over  at  the  end  to  achieve  the  desired  attitude  angle  at  impact. 
A miss  distance  of  18  feet  and  an  attitude  impact  angle  of  37  degrees 
was  achieved  with  the  following  gain  values: 

GPIT  = GYAW  = .0002A3  . 


3. A. 3 Control  Parameter  Improvement 

The  values  of  the  control  parameters  y arid  8 were  altered 
(using  the  Hooke  - Jeeves  Algorithm)  to  improve  performance  in  the 
6D0F  simulation.  Rather  than  attempt  to  incorporate  the  6D0F  simu- 
lation as  a function  subprogram  to  evaluate  F(y,Sl,  it  was  decided 
to  bypass  the  anticipated  programming  difficulty  by  just  running  the 
simulation  any  time  y or  6 was  changed  and  F(y,8)  needed  to  be  re- 
evaluated for  the  H-J  Algorithm.  Although  the  iterations  thus 
perforr.ied  were  slow,  overall  it  seemed  to  be  the  most  straightforward 
way  to  proceed. 

3.5  Sensitivity  Analysis 

3.5.1  Sensitivity  for  the  Four-State  Simulation 

When  the  3-state  control  law  was  used  on  the  6D0F  simulation, 
a small  change  in  lowering  the  missile  velocity  from  1095  ft/sec  to 
1090  ft/sec  resulted  in  the  miss  distance  jumping  to  26A'.  Clearly, 
the  question  of  sensitivity  had  to  be  investigated — first  with  the 
simpler  four-state  simulation  and  then  with  the  6D0F  simulation. 

It  was  noticed  that  the  initial  conditions  for  the  terminal 
guidance  phase  given  by  Equation  (3.19)  had  been  poorly  chosen  in  the 
sense  that  the  target  was  out  of  the  field  of  view,  and  so  an  alternate 
set  was  used: 

Ilj.  = 1000'  , Y^^  = 5000'  , e = 89°  . (3.29) 

The  velocity  was  left  the^same  at  1095  ft/sec  and  the  initial  attitude 
angle  was  increased  to  89  since  the  missile  would  be  flying  approximately 
horizontal  after  the  initial  pre-programmed  pitch  maneuver. 

^ 


Initial  Implementation  of  the  3-State  Controller 
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Varying  each  of  the  initial  conditions  H^,  6,  and 
Vj,j(to)  separately,  Tables  3.3a,  3.3b,  3.3c,  3.3d  were- -generated 
using  the  four-state  simulation.  As  can  be  seen  from  them,  decreases 
in  the  acquisition  range  are  tolerable,  but  when  it  is  increased  to 
6500'  the  simulation  becomes  unstable.  The  height  can  be  increased 
without  detriment,  but  when  lowered  to  800'  instability  occurs.  The 
initial  attitude  angle  can  only  be  decreased  by  two  degrees.  Perfor- 
mance is  most  sensitive  to  decreases  in  velocity — a decrease  of 
5 ft/sec  of  velocity  from  1095  ft/sec  to  1090  ft/sec  causes  instability. 
Recall  that  the  performance  obtained  with  the  6D0F  simulation  consid- 
erably worsened  as  well  when  the  velocity  dropped  5 ft/sec. 

The  above  information  suggests  that  a worst  case  scenario 
about  which  to  optimize  the  control  parameters  might  be: 

H|.  = 1000'  , Yj  - 5000'  , e = 87.5°  , Vj^  = 1080  ft/sec  . (3.30) 

An  initial  attitude  angle  of  87.5  would  hopefully  allow  a larger 
window  for  acceptable  initial  attitude  angles.  A lower  velocity  was 
chosen  as  it  would  be  more  demanding  on  the  control  system.  Using  the 
Hooke  - Jeeves  Algorithm,  the  optimal  control  parameters  turned  out  to 
be 

Y = 5A60.992  , 6 = .189291E-06  (3.31) 

with  a resulting  performance  of 

Y^(tp  = .915'  , 0(t^)  = 45.012°  . (3.32) 

The  four-state  simulation  was  ran  in  double-precision  to  minimize  the 
effect  of  roundoff  error  on  the  results.  Varying  Initial  conditions 
one  at  a time.  Tables  3.4a,  3.4b,  3.4c,  3.4d  were  produced. 

The  changes  in  performance  when  acquisition  range,  height,  or 
initial  attitude  angle  are  altered  agree  qualitatively  with  the  previous 
results.  Yj  can  be  decreased  and  H^.  can  be  increased  with  performance 
remaining  acceptable.  The  interval  of ^acceptable  initial  attitude 
angles  would  be  from  about  86  to  89.5  . T\ie  one  very  curious  coipplete 
reversal  of  sensitivity  is  in  the  variable, Y^.  Previously,  when  Y^ 
lessened,  performance  worsened;  now,  when  Y^  increases,  performance 
v;orsens.  With  these  control  parameters,  the  four-state  simulation 
predicts  that  the  missile  should  not  acquire  the  target  until  its  velocity 
decreases  below  1080  ft/sec. 


3.5.2  Sensitivity  with  the  6D0F  Simulation 

The  choice  of  GPIT,  GYAW  for  the  6D0F  simulation  implementation 
turned  out  to  be  a very  delicate  one  for  the  new  set  of  initial  condi- 
tions. Two  completely  different  types  of  trajectories  were  observed 
for  various  values  of  GPIT,  depending  on  whether  it  was  above  or  below 
some  value  close  to  .0004975.  Wlien  GPIT  was  less,  the  missile  would 
overfly  the  target  and  the  simulation  would  terminate  when  the  maximum 
flight  time  parameter  was  exceeded.  For  GPIT  greater  than  this  number. 
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Table  3.3.  Performance  for  Various  Initial  Conditions  (Baseline  1) 


Table  I.C. 

Variable 

I.C. 

Value 

(ft) 

9(tf)-45 

(deg) 

Baseline  I 
(denoted  by  '*') 

3.3a  Yd(to) 

3000. 

1.61 

-5.31 

H^(t^)  = 1000' 

(ft) 

3500. 

4.63 

-0.24 

4000. 

2.83 

-5.03 

o 

c^ 

00 

II 

c 

<D 

4500. 

3.09 

-0.48 

5000.* 

2.80 

-0.00 

Y^(t^)  = 5000' 

5500. 

-17.85 

-127. to 

6000. 

4.83 

2.39 

Vij(to)  = 1095  ft/sec 

6500. 

- Unstable  - 

3.3b 

Ht(to) 

(ft) 

800. 

900. 

1000.* 

1100. 

1200. 

1300. 

1400. 

1500. 

1600. 

- Unstable  - 
3.05  -3.35 

2.80  -0.00 

5.13  1.04 

2.29  -6.67 

4.77  0.35 

4.37  0.58 

4.97  4.12 

2.79  11.78 

Y = 5535.43 

6 = .18939E-6 

3.3c 

e(to) 

85. 

- Unstable  - 

(deg) 

86. 

5.95 

58.70 

87. 

1.49 

-2.99 

88. 

4.07 

-3.48 

89.* 

2.80 

-0.00 

90. 

2.47 

-2.64 

3.3d 

VM(to) 

1090. 

- Unstable 

- 

(ft/sec) 

1095.* 

2.80 

-0.00 

1100. 

4.14 

0.32 

1105. 

5.65 

3.79 

Table  3. A.  Performance  for  Various  Initial  Conditions 

(Baseline  11) 


Table  I.C.  l.C.  Y^j(tf)  6(tf)-A5  Baseline  11 

Variable  Value  (ft)  (deg)  (denoted  by  '*') 


3.  Aa 

^dCto) 

3000. 

2.A1 

-A.2A 

Ht(to)  = 1000' 

tft) 

3500. 

A. 13 

-0.07 

AOOO. 

A. 96 

0.69 

0(to)  = 87.5° 

A500. 

12.98 

-6.57 

5000. * 

0.92 

0.01 

Yjj(to)  = 5000' 

5500. 

16. 2A 

-0.515 

6000. 

- Unstable 

— 

V^(to)  = 1080  ft/sec 

3.Ab 

Ht(to) 

700. 

- Unstable 

_ 

Y = 5A60.99 

(ft) 

800. 

17. A5 

33. AO 

900. 

-12A.35 

10.97 

B = .18929E-6 

1000.* 

0.92 

0.01 

1100. 

A. 33 

0.78 

1200. 

5.57 

A. 18 

1300. 

3.8A 

0.81 

lAOO. 

3.30 

-3.86 

1500. 

3.9 

-0.08 

1600. 

1.72 

-5.12 

3.  Ac 

0(to) 

85.5 

- Unstable 

_ 

(deg) 

86.5 

5.22 

0.5A 

87.5* 

0.92 

0.01 

88.5 

1.23 

9.79 

89.5 

5.A9 

-0.17 

90.5 

- Unstable 

“ 

3.  Ad 

VM(to) 

1065. 

A.  82 

-0.05 

(f t/sec) 

1070. 

5.8A 

0.87 

1075. 

-0.A6 

-2.05 

• 

1080.* 

0.92 

0.01 

1085. 

- Unstable 

- 

the  missile  would  impact  considerably  short  of  the  target.  Given  the 
seven  digit  accuracy  of  the  computer,  it  was  not  possible  to  obtain 
reasonable  performance.  See  Table  4.1  for  a closer  examination  of 
this  behavior.  (The  control  parameters  y and  6 were  set  at  5460.99 
and  .189291E-6,  respectively.) 


Table  3.5.  Performance  Dependence  on  GPIT 


GPIT 

RXE(ft) 

RZE(ft) 

0 (t j) (deg) 

.0005 

-1210. 

1.1 

-28.6 

.000499 

-1144. 

.8 

-27.5 

.000498 

-945. 

.4 

-46.1 

.000497 

530. 

-567. 

t>t 

max 

t>t 

max 

.000495 

529. 

-591. 

The  control  parameters  were  then  altered  in  the  hope  that 
performance  could  be  improved  and  sensitivity  reduced.  With 

GPIT  = .497843  (3.33) 

and  the  missile  impacting  510.6'  short  of  the  target,  several 
runs  were  made  with  various  values  of  the  control  parameters  y»B. 

As  can  be  seen  from  Table  4.2,  small  changes  can  result  in  a 
totally  different  trajectory. 


Table  3.6  . Performance  Dependence  on  y and  6 


y 

RXE(ft) 

RZE(ft) 

e(t j) (deg) 

5460.996 

.1895E-6 

-510.6 

.5 

-62 

5461. 

.1895E-6 

536. 

-380. 

5460.996 

.1910E-6 

-118. 

178. 

-27.9 

5460.996 

.1920E-6 

536. 

-408. 

‘--‘-max 

Despite  the  small  miss  distance  and  excellent  impact  angle 
achieved  with  the  four-state  simulation,  it  proved  to  be  impossible 
to  achieve  reasonable  performance  through  an  appropriate  choice  of 
the  gain  placed  in  the  pitch  and  yaw  channels.  Since  varying  the 
control  parameters  was  unsuccessful  as  well,  it  was  decided  to  return 
to  the  alternate  set  of  Initial  conditions  for  which  the  missile  was 
14'  above  ground  with  an  attitude  angle  of  38.1°  below  the  horizon. 
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Initially,  the  control  parameters  were 


I 

i 

i 
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* 
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Y = 5525.508  , 6 = .19E-6  , GPIT  = .2A3E-3  . (3. 34) 

Using  the  Hooke  - Jeeves  Algorithm,  the  miss  distance  was  reduced 
to  10.4'  with  an  attitude  angle  of  -38.2°  when  the  control  para- 
meters were  5525.45  and  .160E-6,  respectively. 

Different  runs  were  made  on  the  6D0F  simulation  with  various 
initial  conditions.  Table  3.7  contains  the  results.  The  first  line 
represents  the  baseline  case. 


Table  3.7.  6D0F  Simulation  Runs  for  Various  Initial  Conditions 


0 

CD 

RXE 

RZE 

0(tf) 

-5000. 

-1500. 

-5. 

-10.4 

-38.1 

■BSBlSHH 

-5. 

■IMI  MH  1 1 ■ 

TTB 

-68.9 

-44. 

-5500. 

-1500. 

-5. 

1090.856 

-1065.3 

1.2 

-77.5 

-5000. 

-1400. 

-5. 

1090.856 

-690.7 

.5 

-47.2 

-5000. 

-1600. 

-5. 

1090.856 

-116,7 

1.5 

-89.7 

-5000. 

-1500. 

-4. 

1090.856 

.7 

-150.4 

-32.4 

-5000. 

-1500. 

-6. 

1090.856 

-495.1 

.9 

-41.8 

-5000. 

-1500. 

-5. 

1085.856 

.9 

-127.1 

-35.5 

-5000. 

-1500. 

-5. 

1095.856 

-448.7 

1.2 

-43.4 

As  can  be  seen  from  Table  3.7,  performance  is  very  sensitive 
to  any  change  in  the  initial  condition.  Such  sensitivity  was  not 
observed  with  the  four-state  simulation.  This  is  probably  due  to  the 
fact  that  in  the  simpler  simulation  there  was  no  hard  constraint  on 
the  controller  u;  whereas,  in  the  6D0F  simulation  a bound  of  ± 10° 
existed  for  tail  fin  displacement. 

Figures  3.6  and  3.7  represent  the  baseline  trajectory. 
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Figure  3.7.  THETA  vs.  TIME 


Chapter  IV 


CONTROL  LAW  IMPLEMLNTATION  - PRACTICAL  CASE 


4.1  Disadvantages  of  the  Three-State  Controller 

Only  one  of  the  three  states  used  to  control  the  missile 
can  be  measured,  the  attitude  angle  0.  Both  range  and  range 
rate  are  not  available  as  there  is  no  radar  or  other  such  measuring 
devices  present.  The  laser  guided  missile  can  detect  the  reflected 
laser  beam  and  would  have  X (the  time  derivative  of  the  line-of-sight 
angle  X)  approximated  by  the  seeker.  This  alternate  set  of  state 
variables  (X,X,0)  would  seem  to  be  more  attractive  than  the  set 

because  of  the  possibility  of  using  actual  physical  measurements. 


4.2  A Controller  Using  X,  X 

Figure  4.1  gives  the  relationship  between  the  various  state 

variables . 


MISSILE 


Figure  4.1.  Missile  - Target  Geometry 

Using  Figure  4.1,  the  following  equation  is  obtained. 

Y^  = H^tan(e+X)  . (4.1) 
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Different iat ing , 


Y.  = H Bec^(0+X)  (e+>.)  + tan(e+X)A  . (4.2) 

cl  t t 

Substituting,  the  control  law  becomes  of  the  form 

u = f(X,X,0,9,Hj.,H^)  (4.3) 


where 


f (X ,X,e,0,H^,H^)  = c^H^tan(e+X)  + C2(H^sec^(e+X) (6+X)  (4.4) 

+ tan(0+X)H^)  + c^6  . 

4.3  Implementation  of  the  X,  X,  9 Controller 

Initially,  all  states  were  assumed  to  be  known.  Under 
this  assumption,  the  following  performance  was  obtained: 

Y,(t^)  = ****  , 0(t^)  = ****  _ (4.5) 

d f f 

As  for  implementing  the  two  pairs  of  variables  (X,X  and  9,9), 
one  of  each  pair  will  be  measured  physically,  and  the  other  member 
will  be  approximated  by  some  appropriate  signal  processing — either 
an  integration  or  differentiation  network. 

As  for  the  last  pair,  neither  Hj,  nor  Hj.  can  be  measured 
directly.  It  possible,  however,  to  approximate  Hj.,  if  the  attitude 
and  velocity  of  the  missile  are  known,  by  using 

= -Vj.j-cos  0 . (4.6) 

If  the  initial  height  is  known.  Equation  (4.6)  could  be  used  to 
update  the  estimate  of  Hj..  The  only  way  that  this  might  be  done 
would  be  in  the  design  of  the  preprogrammed  pitch  maneuver. 

There  seems  to  be  no  way  to  avoid  the  need  for  range  and 
range  rate  information.  Equation  (4.6)  seems  to  come  as  close  as 
possible  to  drawing  upon  variables  that  can  be  measured.  The  velocity 
Vjij  is  not  measured  but  does  behave  nicely  throughout  the  flight,  almost 
a linear  function  of  t.  Perhaps  a profile  of  Vj.j  could  be  stored  for 
or  generated  during  the  flight. 


Note:  The  "****"  appearing  in  Equation  (4.5)  have  been  inserted 

since  the  code  had  some  errors  in  it.  These  numbers  should 
be  close  to  those  previously  obtained  since  the  two  formu- 
lations are  mathematically  equivalent.  This  approach  was 
not  followed  up  due  to  the  sensitivity  problem  discussed 
in  Chapter  III.  It  was  felt  that  it  was  important  to 
outline  the  approach  to  be  used. 
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A. 4 Estimation  of  Time-to-go 


The  problem  of  estimating  time-to-go  that  is  needed  for 
the  control  law  remains  even  if  all  other  problems  are  resolved.  A 
fixed  estimate  could  be  used,  but  it  would  have  to  vary  depending  on 
the  initial  conditions. 

A second  approach  might  be  to  use  H and  Hj.,  but  since  these 
two  variables  are  being  estimated,  this  method  probably  would  not  fare 
too  well. 


A third  alternate,  perhaps,  is  to  use  the  seeker.  If  the 
intensity  of  the  reflected  laser  beam  can  be  measured,  along  with 
the  rate  at  which  the  intensity  is  varying,  then  an  estimate  of 
time-to-go  can  be  obtained. 

Intensity  I is  inversely  proportional  to  the  square  of  the 
distance  from  the  missile  to  the  target,  the  slant  range  R.  Thus 

I = k/R^  . 

Differentiating  with  respect  to  time  yields, 

dl/dt  = -2kR“^dR/dt  . 

Hence, 

...  R - 21 

time-to-go  = --y , = — 

® dR/dt  dl/dt 


(4.7) 

(4.8) 

(4.9) 


Chapter  V 


CONCLUSIONS  AND  RECOMMENDATIONS  FOR  FUTURE  STUDY 


Even  assuming  perfect  knowledge  of  the  states  Y^j,  0, 

the  best  performance  that  could  be  obtained  with  the  6D0F  simulation 
was 


RZE  = -10.4  , 6(tf)  = -38.1  . (5.1) 

When  one  considers  that  the  center  of  mass  of  the  target  is  about 
5'  above  ground,  the  performance  is  very  close  to  satisfying  the 
criteria  for  success.  When  actual  measurements  are  used,  one  can 
only  expect  performance  to  deteriorate. 

It  must  be  kept  in  mind  that  the  above  was  assuming  that 
all  states  could  be  measured  exactly.  When  actual  measurements  are 
used  for  some  of  the  variables  and  estimates  tor  others,  the  performance 
will  degrade.  If  the  three-state  controller  is  to  work,  these  errors 
should  be  quite  small. 

The  other  observation  that  needs  to  be  made  is  that  the 
performance  is  extremely  sensitive  to  changes  in  the  initial 
conditions  when  the  target  is  acquired.  Even  if  the  miss  distance 
and  attitude  angle  at  impact  were  zero,  this  sensitivity  would  defeat 
any  practical  implementation  of  the  control  law.  Small  changes  in 
the  control  parameters  also  resulted  in  large  changes  in  performance; 
that  is,  the  assumption  of  continuity  that  was  made  in  determining 
the  control  parameters  is  not  valid  for  the  actual  system  as 
represented  by  the  6D0F  simulation. 

The  only  conclusion  that  can  be  reached  is  that  the  three- 
state  controller  cannot  be  satisfactorily  implemented  in  the  6D0F 
simulation.  The  main  explanation  the  authors  feel  is  that  there  is 
a hard  constraint  on  the  controller  in  the  6D0F  simulation,  but  not 
in  the  four-state  simulation.  This,  more  than  the  assumptions  of 
neglecting  the  angle  of  attack,  or  no  lag  in  the  autopilot,  dictates 
that  the  implementation  will  not  prove  to  be  satisfactory.  The 
control  parameters  can  be  adjusted  so  that  a successful  flight  is 
achieved  for  most  sets  of  initial  conditions,  but  the  extreme  sensitivity 
makes  this  implementation  of  no  value. 

The  authors  feel  that  it  would  be  worthwhile  to  reformulate 
and  solve  the  control  problem  so  that  a hard  constraint  is  present  on 
the  controller.  Such  a controller  (which  will  be  of  the  bang-bang 
variety)  should  be  implemented,  assuming  again  that  all  states  can 
be  measured,  to  verify  whether  or  not  the  presence  of  the  hard  con- 
straint on  the  tail  fin  deflection  is  the  main  culprit  for  the 
sensitivity  problem.  If  successfully  implemented,  then  the  problem 
of  practical  implementation  of  such  a control  law  could  be  examined. 
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This  listing  is  complete  except  for  the  omission  of  sub- 
routines COSD,  SIND,  ATAND  v/hich  are  the  same  as  the  FORTRAN  library 
subroutines  but  work  with  degrees  instead  of  radians. 

The  old  subroutine  DUMMY  has  been  relabeled  TIMEV.  ’TIMEV’ 
was  placed  as  an  entry  point  in  DUMMY  but  the  presence  of  arguments 
caused  a syntax  error  which  was  most  easily  corrected  by  renaming 
subroutine  DUMMY. 

Since  the  altered  simulation  does  not  have  the  random 
error  disturbance  capability,  the  main  program  could  be  shortened 
by  omitting  the  second  half  which  is  the  statistical  analysis  part 
for  Monte  Carlo  sets. 
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EQUIVALENCE  ( C( 3030 ) , IM VCT  ) 

REAL  KSSIG 
INTEGER  CEPSIG 
DIMENSION  CEP3IG(6) 

DIMENSION  T1ME(300) 

DIMENSION  VLABLE(2,15)  , IPL(IOO)  , DER(IOI) 

DIMENSION  VAR(IOI)  , EL(IOO)  , EU(IOO) 

DIMENSION  IMVNDX(IO) 

EQUIVALENCE  (C(1980) 

EQUIVALENCE  (C(1981) 

EQUIVALENCE  (C(1982) 

EQUIVALENCE  ( C ( 1 983 ) , PL0TN2 ) 

EQUIVALENCE  ( C (1 984 ) , NPLOT  ) 


EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 


15)  , IPL(IOO) 

, EL(IOO) 

VMEAN(IO),  VSD(IO) 
KN  ) 

RNT  ) 

PL0TN4) 


EQUIVALENCE  ( C ( 2020 ) , LCON V ) 

EQUIVALENCE  (C( 165  1 ) , RTXE)  , (C(  1655)  , RTYE)  , ( C(  1 659 ) , RTZE ) , 
.(C(lol5),hXE),(C(l6l9),RYE),(C(l623),RZE) 

INTEGER  OPOINT 
INTEGER  OPT 
EXTERNAL  AUXSUB 

DO  1 11 1 I = 1 , 3830 
nil  C(I)  = 0.0 

Q «»»»»»»»»«»  K >»*»»  N K »»  K »«»»« 

ISGCT=0 


I* 
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ISGCT=1 

ITCT=0 

ITCT=1 

M0UE=-1 

IT3NDX=0 


THIS  CALL  TO  SUBROUTINE  RANNUM  IS  TO  PERMIT  USE  OF 
DIFFERENT  RANDOM  NUMBER  GENERATOR  STARTERS  (IRNST). 
IF  SUBROUTINE  NORMAL  IS  CALLED  WITHOUT  FIRST  CALLING 
RANNUM,  THE  RANDOM  NUMBER  SEQUENCE  WILL  ALWAYS 
BE  STARTED  WITH  THE  SAME  NUMBER  (ENTERED  AS  A DATA 
STATEMENT  IN  SUBROUTINE  NORMAL),  WHICH  WILL  RESULT 
IN  THE  SAME  SEQUENCE  ALWAYS  BEING  GENERATED. 

L = 1 
NP  = 0 
CALL  COUNTV 

1000  CALL  ZERO 

1001  IFCPLOTNO.LE. 0. )G0T07 
IFCREPPLT.GT. 0. )G0T07 

REPPLT  = 0.  USE  NEW  NO. 4, 7 (DISCARD  OLD) 
1.  USE  OLD  PLUS  THOSE  ADDED 
-1.  USE  NEW  NO.  7 (DISCARD  OLD) 

IF  (REPPLT. GT. -1 .0)  NOOUT  = 0 
NPLOT=0 
7 CALL  0INPT1 
CONTINUE 

CALL  RANNUM( 1 . ,RNSTRT,DUM) 

IF(ISGCT.GT.O)  CALL  MCARLO  (DUM,  -1,  IDUH) 

C( 1976)  = 1 . 

KASE=0 

LSTEP  = STEP 
NPLOT4=PLOTN4 
NPL0T2=PL0TN2 
N0PL0T=PL0TN0 
NOPLOT =N PLOT 

1002  CALL  SUBL1 
lOOi  CALL  AUXI 

1004  CALL  SUBL2 

1005  CONTINUE 

DER( 101 ) = DER(  1 ) 

IF(DER( 1 ) .GT.DERSV)DER( 1 )=DERSV 
C(  1976)=  1 . 

1006  CALL  AUXSU3 

1007  NJ=N-1 

CALL  AMRK(AUXSUB) 

1003  CONTINUE 
1009  CONTINUE 

RDELX=RTXE-RXE 

RDELY=RTYE-RYE 

RDELZ=RTZE-RZE 

IF(RDELZ  ,LT.  0.  .OR.  RDELX  . LT . 0.)  LC0NV=2 
CALL  SUBL3 

IF  ( KSTEP  .EQ.  1 ) GO  TO  1007 


ooooonnoo  oooo  oono 


C 

miss  distance  for  each  run  of  the  monte  carlo 

RUN  StT************************************************ 


IFdCEP.NE.  1 ) GO  TO  20 

LCEP=0 

NP  = NP  + 1 

X(NP)  = RYF 

Y(NP)  = RZF 

RMISST(NP)  = RMISS 

GO  TO  21 

20  CONTINUE 
NRITE(6,805) 

805  FORMATdHO,///) 

WHITE(6,22)  L 

22  FORMATdHO,  1 IX, 2bH»$*$»$  WARNING  RUN  NUMBER  ,13, 

2 37H  DID  NOT  INTERSECT  TARGET  PLANE*$»$*$  , / , 

3 // ,26X, 38H$*$»THIS  RUN  DROPPED  FROM  DATA  SET»$»$) 
WRITE(b,805) 

21  CONTINUE 
L = L + 1 


CONTROL  PARAMETER  OUTPUT 

PRINT  N66,C(2916) ,C(2917) ,C(2918) ,C(2919) ,C(2920) ,C(2921 ) 
466  FORMATdHO, ' GAMMA  = ',E15.6,4X,'  BETA=  ',E15.6,/, 

1'  KA  = ',F10.6,4X,'  K1  = ',F10.6,4X,'  W1  = ',F10.6,/, 
2'  GPIT  = ' ,F10. 6) 

THOFF  = C(350)+45 
WRITECb , 1212)  C(  350),  THOFF 
t ^ F0RMAT( 'OTHETA  MISSILE  IN  DEGREES  =',E15.7 

VARIATION  FROM  DESIRED  45  DEGREE  IM PACT= ' , E 1 5 . 7 , / / ) 

PLOTTING  ROUTINE********* 

CALL  WKPLOT 

plotting  routine***** 


CALL  PROCES 

IF  (OPTNIO  .GT.  0.)  CALL  DUMPO 
CALL  RESET 

IF (LSTEP. Eg. 5 . OR . LSTEP . EO. 7 . OR . NOPLOT . EQ. 0 )G0T05 
CALL  TIMEV(DELT) 

WRITECb, 96)DELT 

96  FOKMATCIH  ,17HSTART  PLOTTING  AT,F14.7) 

LESSPTrPTLESS 

OPOINTrOPOINT-LESSPT 

Call  PL0T4(GRAPH ,0P0I NT, VLABLE, time, NPL0T4, NPL0T2, NOPLOT) 

CrtL.L  PL0T2 

CALL  PLOTN 

CALL  TIMEV(DELT) 

WRITECb, 97)DELT 


43 


noonooonn  ooonoo 


97  FOSMATdH  ,18HPL0TTING  ENDED  AT  ,F1M.7) 

5 GO  TO  ( 1000,  1001  . 1002,  1003,  100^4,  1005,  1006,  1007,  1008,  1009,  1010)  , 
1 L3TEP 
1010  CONTINUE 


****  MEAN  VARIANCE  AND  STANDARD  DEVIATION 


WKITE(6 ,100) 

100  FORMATC 1H1 , 13X, 30HMEAN  VARIANCE  AND  STANDARD  DEVIATION/, 
1 7X,  10HC-LOCATION,9X,8HMEAN  VA R , 1 9X , 7HSTD  DEV/) 

DO  120  1=1 , IMVCT 
ILOC  = IMVNDX(I) 

WRITE (6, 102)  ILOC,VMEAN(I) ,VSD(I) 

102  F0RMAT(10X,I5,8X,E15.8,  nX,E15.8) 

120  CONTINUE 


*»»»»*»»»*»»MONTE  CARLO  AND  CEP  LOGIC  FOLLOWS*»»»«**»»»»»*»**»»»»»*»»»» 


IFCNP.LT.NCASE.AND.L.LE. (NCASE+5) )WRITE(6,807) 

IFCNP.LT.NCASE. AND.L.LE. (NCASE+5) )G0  TO  8 
807  FORMATdHI  , 3(/)  ,39H  THIS  RUN  ADDED  DUE  TO  BREAKLOCK  , 3 ( / ) ) 

J =0 

r%;',  WKITE(6,800) 

800  FORMATdHI,  96X  , 1 0H  Y-M  ISS  ,10HZ-MISS  ,10HMISS  DIST  /, 

1 6X,123H 

2  lii 

3—) 

DO  801  1 = 1 , NP 
J = J +1 

WRITE (6, 802)  X(I) ,Y(I) ,RMISST(I) 

802  FORMATC  6X,10H1  ,10H1  ,10H1  ,10H1 

1,10H1  ,10H1  ,10H1  ,10H1  ,10H1 

2 ,1H1,F9.5,2H  1,F9.8,2H  1,F8.5,2H  1) 

WRITE(6 , 803) 

803  FORMAT(  6X,  123H 


2  j 

3  ) f 

IF(J.GT.30)  WRITE  (6,800) 

IF(J.GT.30)  J = 0 ! 


801  CONTINUE 

IF(  IBL.LE.OGO  TO  80^4 

L = L-1 

XIBL=IBL 

XL=L 

RATIO=XIBL/XL 
WRITE(6,806)IDL,L, RATIO 
8Uo  FORMAT (1H 1,15(/),1X,10(1 1H»BREAKLOCK» ) , 

/ , IX  , nH*BREAKLOCK»  , 3X,  16HTHIS  RUN  SET  HAD,  144 , 25HBREAKLOCK 

• FLIGHTS  OUT  OF  , 1 4 , 23HGI VI NG  A PROPORTION  OF . , F6 . 4 , 4X , 1 1H*BREAKL0C 

• K , 

/,1X,  9HBREAKL0CK  ,3X,17HTHIS  RUN  SET  HAD  , 14 , 24HBREAKLOCK  FL 


44 


.IGHTS  OUT  OF  ,14  ,23HGIVING  A PROPORTION  OF  , F6 . 4 , 4X , 9HBREAKLOCK , 
/ , IX,  nH*BREAKLOCK»  ,88X  , 1 1H*BREAKLOCK»  , 

/ , IX,  nH»BREAKLOCK*  ,88X,  nH»BREAKLOCK»  , 

/ IX,  10(  nH»BREAKLOCK*)  ) 

804  CONTINUE 

CALL  CEPA3(NP, IBVNSW,IPLOT,XLAMBD,KSSIG,CEPSIG, PSIZE) 

4668  CONTINUE 
CALL  EXIT 
STOP 
END 
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SUBROUTINE  AMKK(AUXSUB) 

COMMON  C(3830) 

DIMENSION  CSAV(IOO),  IPL(IOO) 

REAL  KKIOO),  K2(100),  K3(100),  K4(100) 

EQUIVALENCE  (C(2000),  T) 

EQUIVALENCE  (C(2664),  DELT) 

EQUIVALENCE  (C(1974),  NJ) 

EQUIVALENCE  (C(2562),  IPL(1)) 

EQUIVALENCE  ( C( 1 976 ) , XNDRK) 

XNDRK  = -1 . 

DO  1 I = 1,NJ 
J = IPL(I) 

C 

C**»»sTORE  INITIAL  VALUES 
CSAV(I)  = C(J+3) 

C 

C*»»  COMPUTE  K1 

KKI)  = DELT»C(J) 

1 C(J+3)  = CSAV(I)  + .b*K1(I) 

T = T + .5»DELT 

C\LL  aUXSUB 
C 

C*»*  COMPUTE  K2 

DO  2 I = 1 , NJ 
J = IPL(I) 

K2(I)  = DELT»C(J) 

2 C(J-^3)  = CSAV(I)  + .b»K2(I) 

CALL  AUXSUB 

C 

C*»»  COMPUTE  K3 

DO  3 I = 1 , NJ 
J = IPL(I) 

X3(I)  = DELT*C(J) 

3 C(J+3)  = CSAV(I)  + K3(I) 

T = T + .5*DELT 

CALL  AUXSUB 
C 

C**»  COMPUTE  K4 

DO  4 I = 1 , NJ 
J = IPL(I) 

K4(I)  = DELT»C(J) 

4 C(J+3)  = (.3AV(I)  +(KUI)  + 2.*(K2(I)  + K3(I))  + K4(I))/6. 
XNDRK  = 1. 

CALL  AUXSUB 

RETURN 

END 
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SUBROUTINE  AUXI 
COMMON  C(3830) 

EOUIVALENCE  (C(2361 ) , NOMOD  ),( C( 2362 ), XMODNOd )),( C( 256 1 ), N ) 
DIMENSION  XMODNO(99) 

N = 1 

DO  1 1=1, NOMOD 
L =XMODNO(I) 

GO  TO  (1,2,3,^,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23 
1 ,24,25,26,27,28,29,30,31 ,32,33,34,35,36,37) ,L 


2 

CALL 

All 

GO 

TO 

1 

3 

CALL 

A2I 

GO 

TO 

1 

4 

CALL 

A3I 

GO 

TO 

1 

5 

CALL 

A4I 

GO 

TO 

1 

6 

CALL 

A5I 

GO 

TO 

1 

7 

CALL 

C1I 

GO 

TO 

1 

8 

CALL 

C2I 

GO 

TO 

1 

9 

CALL 

C3I 

GO 

TO 

1 

10 

CALL 

C4I 

GO 

TO 

1 

1 1 

CALL 

C5I 

GO 

TO 

1 

12 

CALL 

C6I 

GO 

TO 

1 

13 

CALL 

C7I 

GO 

TO 

1 

14 

CALL 

C8I 

GO 

TO 

1 

15 

CALL 

C9I 

GO 

TO 

1 

16 

CALL 

C10I 

GO 

TO 

1 

17 

CALL 

Dll 

GO 

TO 

1 

18 

CALL 

D2I 

GO 

TO 

1 

19 

CALL 

D3I 

GO 

TO 

1 

20 

CALL 

D4I 

GO 

TO 

1 

21 

CALL 

D5I 

GO 

TO 

1 

22 

CALL 

G1I 

GO 

TO 

1 

23 

CALL 

G2I 

GO 

TO 

1 

24 

CALL 

G3I 

GO 

TO 

1 

25 

CALL 

G4I 

GO 

TO 

1 

26 

CALL 

G5I 

GO 

TO 

1 
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27 

CALL 

G6I 

GO  TO 

1 

23 

CALL 

S1I 

GO  TO 

1 

29 

CALL 

S2I 

GO  TO 

1 

30 

CALL 

S3I 

GO  TO 

1 

31 

CALL 

S4I 

GO  TO 

1 

32 

CALL 

S5I 

GO  TO 

1 

33 

CALL 

S6I 

GO  TO 

1 

34 

CALL 

S7I 

GO  TO 

1 

35 

CALL 

381 

GO  TO 

1 

36 

CALL 

S9I 

GO  TO 

1 

37 

CALL 

S10I 

1 

CONTINUE 

RETUR 

N 

END 

SUBKOUTINE  AUXSUB 
COMMON  C(3830) 

EQUIVALENCE  (C(200Q) ,T) , (C(2361 ) , NOMOD ) , ( C ( 2 362 ) ,XMODNO( 1 ) ) 
EQUIVALENCE  (C(2561  ),N  ),  ( C ( 2562 ) , I PL  ( 1 ) ) , ( C ( 2664 ) , DER ( 1 ) ) 

EQUIVALENCE  ( C ( 2965 ) , VA R ( 1)  ) 

EQUIVALENCE  ( C ( 2020 ) , LCON V ) 

DIMENSION  DER(IOI)  , VAR(IOl)  , IPL(IOO) 

DIMENSION  XM0DN0(99) 

EXTERNAL  A1 
EXTERNAL  A2 
EXTERNAL  A3 
DO  1 I=1,NOMOD 
IF(LC0NV.EQ.2)HETURN 
L =XMODNO(I) 

GOTO  (1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22, 
1 23 , 24 , 25 , 26 , 27 , 28 , 29 , 30 , 3 1 , 32 , 33 , 34 , 35 , 36 , 37  ) , L 


2 

CALL 

A1 

GO 

TO 

1 

3 

CALL 

A2 

GO 

TO 

1 

4 

CALL 

A3 

GO 

TO 

1 

5 

CALL 

A4 

GO 

TO 

1 

6 

CALL 

A5 

GO 

TO 

1 

7 

CALL 

C 1 

GO 

TO 

1 

8 

CALL 

C2 

GO 

TO 

1 

9 

CALL 

C3 

GO 

TO 

1 

10 

CALL 

C4 

GO 

TO 

1 

1 1 

CALL 

C5 

GO 

TO 

1 

12 

CALL 

C6 

GO 

TO 

1 

13 

CALL 

C7 

GO 

TO 

1 

14 

CALL 

C8 

GO 

TO 

1 

15 

CALL 

C9 

GO 

TO 

1 

16 

CALL 

CIO 

GO 

TO 

1 

17 

CALL 

D1 

GO 

TO 

1 

18 

CALL 

D2 

GO 

TO 

1 

19 

CALL 

D3 

GO 

TO 

1 

20 

CALL 

D4 

GO 

TO 

1 

21 

CALL 

D5 

GO 

TO 

1 

22 

CALL 

G1 

GO 

TO 

1 

23 

CALL 

G2 
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GO  TO  1 

2H  CALL  Gj 
GO  TO  1 

25  CALL  G4 
GO  TO  1 

26  CALL  G5 
GO  TO  1 

27  CALL  G6 
GO  TO  1 

28  CALL  SI 
GO  TO  1 

29  CALL  S2 
GO  TO  1 

30  CALL  S3 
GO  TO  1 

31  CALL  S^l 
GO  TO  1 

32  CALL  S5 
GO  TO  1 

33  ChLL  S6 
GO  TO  1 

3^1  CALL  S7 
GO  TO  1 

35  CALL  S8 
GO  TO  1 

36  CALL  S9 
GO  TO  1 

37  CALL  S10 
1 CONTINUE 

RETURN 

END 
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BKOUTINE  A1 
COMMON  C(3830) 

C 

C*»TABLE  LOOKUP  FOR  AERO  COEF 
COMMON 

•/NC1Z/NC1  (2)  /NC2Z/NC2(n)  /NC3Z/NC3(4)  /NC5Z/NC5(4) 

*/CA1/VM1(15)  /CA2/BA2(6) , VM2(6)  /CA3/BA3(7 ) , VM3(5 ) 

*/CA5/BA5(Y)  ,VM5(3) 

»/CZPFZ/CZPF(35)  /CZ2FZ/CZ2F(35)  /CMPFZ/CMPF ( 35 ) /CM2FZ/ CM2F ( 35  ) 
*/CY4FZ/CY4F(36)  /CN4FZ/CN4F( 36)  /CL4FZ/CL4F ( 2 1 ) /CL2FZ/CL2F ( 2 1 ) 
*/CZDFZ/CZDF(35)  /CMDFZ/CMDF(35) 

«/CM0FZ/CMQF(36)  /CLPFZ/CLPF(36)  /CLDFZ/ CLDF ( 2 1 ) 

»/CXOF2/CXOFU5) 

COMMON  /CMOFZ/CMOF(6)  /CA4Z/CA4C6) 

COMMON  /NC6Z/NC6(4)  /CA6/BA6 (6 ) , VM6 (4 ) /DXCPFZ/DXCPF(24  ) 

COMMON  /NC7Z/NC7(4)  /CA7/BA7 ( 9 ) , VM7 ( 3 ) /DCMFZ/DCMF( 27 ) 

COMMON  /NCbZ/NC8(2)  /CA8Z/CA8(3)  /DCMOFZ/DCMOF ( 3 ) 

C 

C»*INPUT  DATA 

EQUIVALENCE  ( C (1 200 ) , OPTA 1 ) 

EQUIVALENCE  (C(1240),CLl  ) 

EQUIVALENCE  (C(1241),CL2  ) 

EQUIVALENCE  (C(1242),CL3  ) 

EQUIVALENCE  ( C( 1 24 3 ) , DCM IF ( 1 ) ) 

EQUIVALENCE  (C(124b),CL0  ) 

EQUIVALENCE  ( C(  1 307  ) , RFLGTH  ) 

**INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  ( C(0204 ) , VMACH  ) 

EQUIVALENCE  ( C( 0 367 ) , BALPH A ) 

EQUIVALENCE  ( C( 0368 ) , BALPHY ) 

EQUIVALENCE  ( C ( 0 369 ), BALPH P ) 

EQUIVALENCE  ( C( 0 370 ) , BPH I P ) 

EQUIVALENCE  ( C( 1 1 96 ) , BDELT 1) 

EQUIVALENCE  ( C ( 1 1 97 ) , BDELT2 ) 

EQUIVALENCE  ( C ( 1 1 98 ) , BDELT3 ) 

EQUIVALENCE  ( C ( 11 99 ) , BDELT4 ) 

EQUIVALENCE  (C(1551),OPTM  ) 

EQUIVALENCE  ( C(  1 555 ) , UDL  1 ) 

EQUIVALENCE  ( C( 1 556 ) , UDL2  ) 

EQUIVALENCE  ( C ( 1 557 ) , UDL 3 ) 

EQUIVALENCE  ( C ( 1 558 ) , UDL4  ) 

C 

C»»INPUTS  FROM  MAIN  PROGRAM 

EQUIVALENCE  (C(2000),T  ) 

EQUIVALENCE  ( C ( 2020 ) , LCON V ) 

C 

C»»OUTPUT  TO  MODULES 

EQUIVALENCE  ( C( 1 200 ) , OPTHNG ) 

EQUIVALENCE  (C(1203),CX  ) 

EQUIVALENCE  (C(1204),CY  ) 

EQUIVALENCE  (C(1205),CZ  ) 

EQUIVALENCE  (C(1206),CLP  ) 

EQUIVALENCE  (C(1207),CMQ  ) 

equivalence  (C( 1208), CNR  ) 

EQUIVALENCE  (C(1209),CL  ) 

EQUIVALENCE  (C(1210),CM  ) 

EQUIVALENCE  (C(1211),CN  ) 

C 


EQUIVALENCE  ( C( 1 237 ) , CCQ) 

EQUIVALENCE  ( C( 1 238 ) , CCR ) 

EQUIVALENCE  (C( 1 239 ) , CCRTOQ) 

EQUIVALENCE  ( C(  1 257 ) , SDP ) 

EQUIVALENCE  ( C( 1 257 ) , SDQ ) 

EQUIVALENCE  ( C ( 1 277 ) , SDR ) 

C»»OTHER  OUTPUTS 

EQUIVALENCE  (C(1212),CX0  ) 

EQUIVALENCE  (C(1213),CZO  ) 

EQUIVALENCE  ( C ( 1 2 1 4 ) , DCZ2  ) 

EQUIVALENCE  ( C ( 1 2 1 5 ) , CZDQ  ) 

EQUIVALENCE  ( C ( 1 2 1 5 ) , CZDR  ) 

EQUIVALENCE  ( C(  1 2 1 7 ) , DC  Y4  ) 

EQUIVALENCE  (C(121B),CM0  ) 

EQUIVALENCE  ( C(  1 2 1 9 ) , DCM2  ) 

EQUIVALENCE  ( C ( 1 220 ) , CMDQ  ) 

EQUIVALENCE  ( C ( 1 22 1 ) , CMDR  ) 

EQUIVALENCE  (C(1222),DCN4  ) 

EQUIVALENCE  ( C ( 1 22 3 ) , DCL  1 ) 

EQUIVALENCE  ( C( 1 224 ) , DCL4  ) 

EQUIVALENCE  ( C ( 1 225 ) , CLDP  ) 

EQUIVALENCE  (C(122b),VM  ) 

EQUIVALENCE  (C(1227),BAP  ) 

EQUIVALENCE  (C(122a),BDL  ) 

EQUIVALENCE  (C(1229),BDM  ) 

EQUIVALENCE  (C(1230),BDN  ) 

EQUIVALENCE  (C(1231),BDP  ) 

EQUIVALENCE  (C(1232),BDQ  ) 

EQUIVALENCE  (C(1233),BDR  ) 

EQUIVALENCE  (C(1235),CH1  ) 

EQUIVALENCE  (C(1237),CH2  ) 

EQUIVALENCE  (C(1238),CH3  ) 

EQUIVALENCE  (C(1239),CH4  ) 

EQUIVALENCE  (C(  1240),CHn  ) 

EQUIVALENCE  ( C( 1 24 1 ) , CH2 1 ) 

EQUIVALENCE  (C(1242),CH31  ) 

EQUIVALENCE  ( C( 1 243 ) , CH4 1 ) 

DIMENSION  NDCLD(2),  DCLDVM(3),  DCLD0F(3),  DCLDAF(3) 
DIMENSION  DCLDFF(3),  DCM1F(3) 

EQUIVALENCE  (C(1234),  DCLDO) 

EQUIVALENCE  (C(1235),  DCLDA) 

yan  parameter  input 

EQUIVALENCE  ( C ( 2 90 1 ) , OPTN YW ) 

C 

DATA  WATLB1/4HCX0  / , WATLB2/4HCM0  / , WATLB3/^HCZ0  /,WATLB4 
///4HCM0  / 

DATA  WATLB5/4HDCM2/  ,WATLB6/4HCZDQ/,WATLB7/'4HCMDQ/,WATLB8/ 
//4HDCZ2/ 

DATA  WATLB9/4HDCY4/ ,WATL10/4HDCN4/ ,WATLn/4HCLP  /,WATL12/ 
//41iCMQ  / 

DATA  WATL13/4HCNR  / , WATL 1 4/4HCLDP/ , WATL 1 5/4HDCL4/ 

DATA  NATL16/4HDCL2/ ,WATL17/4H  / , WATL  1 8/4H DXC P/ 

DATA  NATL19/4HDCM  / 

DATA  NDCLD  /3,0  / 

DATA  DCLDVM  / .500,. 950,  1.250/ 

DATA  DCLDOF  / . 000 , - . 00 1 3 , . 00 1 0/ 

DATA  DC LDAF/-. 0015, -. 0023, -.0010/ 

DATA  DCLDFF/ .06,  . 10,  .04/ 

DATA  SDPCC ,SCCRQ/0 . 0, 0. 0/ 
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C MULTIPLE  ANGLE  FORMULAE  AND  ABSOLUTE  VALUES  OF  ANGLE  OF  ATTACK 
USPHI  = SINDCBPHIP) 

UCPHI  = COSD(BPlilP) 

US2PHI  = SIND(2.*BPHIP) 

US^PHI  = SIND(4 .*BPHIP) 

US2PH2  = US2PHI*»2 

»*LIMIT  TABLE  ARGUMENTS 

BDP=(-BDELT1-BDELT2+BDELT3+BDELT4 )/4+SDP+SDPCC 
BDg=(+BDELT1+BDELT2+BDELT3+BDELT4)/4+SDQ+SCCRQ 
BDR=(-BDELT l+BDELT2-BDELT3+BDELT4)/4+SDR 
SDPCC=CCQ»BDg+CCR»BDR 
SCCRg=CCRTOQ«BDR 
BAP  = BALPHP 
UAL  = ABS(BALPHA) 

UBT  = ABS(BALPHY) 

VM  = VMACH 

IF  (BAP.GT.20. )BAP=20, 

IF  (UAL.GT.20. )UAL=20. 

IF  (UBT.GT. 20. )UBT=20. 

C 

C»»TABLE  LOOKUP  FOR  AERO  COEF 

IF(T.GT.  0.  .AND.  C( 1 976 ) . LT . 0 . ) GO  TO  1000 
XF=0. 

CXO  = FINTP  1 ( VM  , VM  1 , CXOF  , NCU  1 ) ,XF  , WATLBl  ) 

XF  = 0. 

CM0  = FINTPU  VM,CA4,CM0F,NC2(1  ) ,XF,WATLB2) 

XF=0. 

CZ0=FINTP2(BAP, VM , BA3, VM3, CZPF , NC3C1 ) , NC3(2 ) , NC3 ( 3 ) , XF , WATLB3 ) 
CM0=FINTP2(BAP, VM,BA3, VM3,CMPF,NC3(1 ) ,NC3(2) , NC3 ( 3 ) , XF , WATLB4 ) 
DCM2=FINTP2(BAP, VM,BA3, VM3,CM2F,NC3(1 ) , NC3 ( 2 ) , NC3 ( 3 ) ,XF,WATLB5) 
CZDg=FINTP2(BAP, VM,BA3,VM3,CZDF,NC3(1 ) , NC 3 ( 2 ) , NC3 ( 3 ) , XF , WATLB6) 
CZDR  = CZDg 

CMDg=FINTP2(6AP, VM , BA3 , VM3 , CMDF , NC3 ( 1 ) , NC3 (2 ) , NC3 ( 3 ) , XF , WATLB7 ) 
CMDR  = CMDg 

DCZ2=FINTP2(BAP, VM,BA3, VM3,CZ2F,NC3( 1 ) , NC3 ( 2 ) , NC3 ( 3 ) ,XF,WATLB8) 
XF=0. 

DCY4=FINTP2(BAP, VM,BA2, VM2,Cy4F,NC2(1 ) , NC2 ( 2 ) , NC2 ( 3 ) ,XF,WATLB9) 
DCN4=FINTP2(BAP, VM ,BA2, VM2,CN4F ,NC2{ 1 ) , NC2 ( 2 ) , NC2 ( 3 ) , XF , WATL 1 0 ) 
CLP:FINTP2(BAP, VM,BA2, VM2,CLPF,NC2( 1 ) , NC2 ( 2 ) , NC2 ( 3 ) , XF , WATL 11 ) 
XF=0. 

CMg=FINTP2{UAL, VM ,BA2, VM2,CMQF ,NC2(1 ) , NC2 ( 2 ) , NC2 ( 3 ) ,XF , WATL12) 
XF=0. 

CNR=FINTP2(UBT, VM,BA2, VM2.CMgF ,NC2(1 ) , NC2(2 ) , NC2(3 ) ,XF,WATL13) 
XF=0. 

CLDP=FINTP2(BAP, VM ,BA5, VM5,CLDF,NC5( 1 ) , NC5 (2 ) , NC5 ( 3 ) , XF , WATL 1 4 ) 
DCL4=FINTP2(BAP, VM,BA5,VM5,CL4F,NC5(1 ) , NC5 (2 ) , NC5 ( 3 ) ,XF,WATL1b) 
DCL2=FINTP2(BAP, VM , BA5 , VMS , CL2F , NC5 ( 1 ) , NC5 ( 2 ) , NC5 ( 3 ) , XF , WATL 1 0 ) 
XF=0. 

DCLD0=FINTP1 ( VM , DCLDVM , DCLDOF , NDCLD ( 1 ) ,XF,WATL17) 
DCLDArFINTPK  VM  , DCLDVM  , DCLDAF  , NDCLD  (1  ) ,XF,WATL17) 
DCLDF=FINTP1 ( VM , DCLDVM , DCLDFF , NDCLD ( 1 ) ,XF,WATL17) 

XF=0. 

DXCP=FINrP2(BAP, VM ,BA6, VM6,DXCPF ,NC6(1 ) , NC6 (2 ) , NC6 ( 3 ) ,XF ,WATL18) 
XF=0. 

DCM=FINTP2(BAP, VM,BA7, VM7,DCMF,NC7(1 ) ,NC7(2) ,NC7(3) ,XF,WATL19) 
XF=0  . 

DCM0=FINTP1(  VM,CA8,DCMOF,NC8( I ),XF,WATL17) 

DCM1=FINTP1(  VM,CA8,DCM1F,NC8(1 ) ,XF,WATL17) 

CMO  : CMU  - CMO 


I 
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CMU  = CMO  + 
1000  CONTINUE 
C 

C**AEHO  COEF  WIND 
DCM0=0. 0 
CZP  = CZO  + 
CMP  = CMO  + 
CNP  = 

CYP  = 


DXCP*CZ0*1 0. 8 


AXIS 

DCZ2»US2PH2  + 
DCM2»US2PH2  + 
DCN^»USi1PHI  + 
DCY4*US4PHI  + 


CZDQ*UCPHI»BDQ  - 
CMDQ*UCPHI«BDQ  - 
CMDQ»USPHI»BDQ  + 
CZDQ*USPHI»BDQ  + 


CZDR»USPHI»BDR 

CMDR»USPHI»BDR 

CMDR»UCPHI«BDR 

CZDR»UCPHI»BDR 


**  TRANSFORMATION  FROM  WIND  TO  BODY  AXIS 
CX  = CXO 

CL  = DCL2*US2PHI+  DCL4»US4PHI  + CLDP»BDP 

CY  = CYP*UCPHI  - CZP»USPHI 

IFCOPTNYW.GT.O. )CY=0. 

CZ  = -CYP*USPHI  - CZP*UCPHI 

CN  = CNP*UCPHI  - CMP»USPHI 

CM  = CNP»USPHI  + CMP»UCPHI  + CMO  + DCMO 
DCLDR  = DCLDO+  DCLDA»SIN (6 . 2832»DCLDF«BALPHP) 

IFIOPTAI  .LE.  2.)  GO  TO  1 
CL  = CL  + DCLDR*BDR 
RETURN 

1 CL  = CL  + CLO  + (CL1»USPHI+CL2*US2PHI+CL3»SIND(3.*BPHIP) )»BAP/8. 
RETURN 
END 
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SUBKOUTINE  A2 

C»«AERO  FORCE  AND  MOMENT  MODULE 
COMMON  C(3830) 

101  FORMAT(1HO,4X,21HFRONT  LUG 


• 9HREL 

VEL 

= , 1 

PE10.2, 

5X 

PUT  DATA 

EQUIVALENCE 

(C( 

1 

306) 

, RFAREA 

,) 

EQUIVALENCE 

(C( 

1 

307) 

.RFLGTH 

1) 

EQUIVALENCE 

(C( 

1 

316) 

,RLUG 

) 

EQUIVALENCE 

(C( 

1 

317) 

.RAIL 

) 

EQUIVALENCE 

(C( 

1 

330) 

,AGV 

) 

EQUIVALENCE 

(C( 

1 

742) 

, AMP2) 

EQUIVALENCE 

(C( 

1 

332) 

.CPHAS 

) 

EQUIVALENCE 

(C( 

1 

333) 

,AGH 

) 

EQUIVALENCE 

(C( 

1 

334) 

,RLGZ 

) 

EQUIVALENCE 

(C( 

1 

405) 

.QBURN 

) 

EQUIVALENCE 

(C( 

1 

627) 

, AGRAV 

) 

BODY  AXES 

CLEARS  RAIL,5X,3HT  = , 1 PE  1 0 . 2 , 5X , 
1HPITCH  MOMENT  =,1PE10.2) 


(C( 17^6) 


AMP1  ) 


C»*INPUTS  FROM  OTHER  MODULES 
DIMENSION  ISNDX(40) 


'.4 


VALENCE 

(C(3634) 

, ISNDX 

VALENCE 

(C(0203) 

, PDYNMC) 

VALENCE 

(C(  204) 

, VMACH 

) 

VALENCE 

(C(0207) 

, VAIRSP) 

VALENCE 

(C(  350) 

,BTHT 

) 

VALENCE 

(C(  380) 

, RANGO 

) 

VALENCE 

(C(T203) 

,CX 

) 

VALENCE 

(C( 1204) 

,CY 

) 

VALENCE 

(C( 1205) 

,CZ 

) 

VALENCE 

(C( 1206) 

,CLP 

) 

VALENCE 

(C(1207) 

,CMQ 

) 

VALENCE 

(C(1208) 

,CNR 

) 

VALENCE 

(C( 1209) 

,CL 

) 

VALENCE 

(C( 1210) 

,CM 

) 

VALENCE 

(C( 121 1 ) 

,CN 

) 

VALENCE 

(C( 1236) 

,CH1 

) 

VALENCE 

(C( 1237) 

,CH2 

) 

VALENCE 

(C( 1238) 

,CH3 

) 

VALENCE 

(C( 1239) 

,CH4 

) 

VALENCE 

(C(1320) 

.FMXTH 

) 

VALENCE 

(C( 1 321 ) 

.FMYTH 

) 

VALENCE 

(C(1322) 

.FMZTH 

) 

VALENCE 

(C( 141 1 ) 

,FTHX 

) 

VALENCE 

(C( 1412) 

,FTHY 

) 

VALENCE 

(C( 1413) 

,FTHZ 

) 

VALENCE 

(C(1422) 

,RLCG 

) 

VALENCE 

(C( 1723) 

,CFA23 

) 

VALENCE 

(C( 1735) 

,CFA33 

) 

VALENCE 

(C( 1739) 

, WP 

) 

VALENCE 

(C( 1743) 

,WQ 

) 

VALENCE 

(C( 1737) 

, FMX 

VALENCE 

(C( 1747) 

,WR 

) 

VALENCE 

(C( 1748) 

, FMIX 

VALENCE 

(C( 1738) 

, WPTO 

VALENCE 

(C( 1751 ) 

, CHAD 

VALENCE 

(C(  626) 

, VIB 

VALENCE 

(C(2000) 

,T 

) 

VALENCE 

(C( 1972) .RKUTTA 

(C(3512),  13512) 


(C( 1741 ) 


FMY),  (C(1745),  FMZ) 


i 
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EQUIVALENCE  ( C(  1 975 ) , NPT ) 

••OUTPUTS 

EQUIVALENCE  ( C( 1 300) ,FXBA  ) 

EQUIVALENCE  ( C ( 1 30 1 ) , FYBA  ) 

EQUIVALENCE  ( C( 1 302 ) , FZBA  ) 

EQUIVALENCE  (C( 1 303) ,FMXBA  ) 

EQUIVALENCE  ( C( 1 304 ) ,FMYBA  ) 

EQUIVALENCE  ( C( 1 305 ) , FM2BA  ) 

EQUIVALENCE  ( C( 1 303 ) , RDELCG ) 

EQUIVALENCE  ( C ( 1 628 ) , DM ASS  ) 

EQUIVALENCE  ( C ( 1 74 8 ) , FMIX  ) 

EQUIVALENCE  (C(1749),FMIY  ) 

EQUIVALENCE  ( C( 1 750 ) , FMIZ  ) 

••OTHER  OUTPUTS 

EQUIVALENCE  ( C(  1 309 ) , FMH 1 ) 

EQUIVALENCE  ( C( 1 3 1 0 ) , FMH2  ) 

EQUIVALENCE  (0(1311), FMH3  ) 

EQUIVALENCE  ( C( 1 3 1 2 ) , FMH4  ) 

EQUIVALENCE  ( C( 1 323 ) , FMXLUG ) 

EQUIVALENCE  ( C( 1 324 ) , FMYLUG ) 

EQUIVALENCE  ( C ( 1 325 ) , FMZLUG ) 

EQUIVALENCE  ( C( 3504 ) , OPTN4 ) 

DATA  FLG2,FLGl/0. ,0./ 

••FORCE  VECTOR  COMPONENTS 
UQS  = PDYNMC»RFAREA 
UQSL  = UQS'RFLGTH 

FXBA=UQS^(-CX)+FTHX 

FYBA=UQS*CY+FTHY 

FZBA=UQS*CZ+FTHZ 

••  AERO  MOMENTS  (NOTE  FACTOR  OF  2.0  IN  DAMPING  COEFFICIENT) 
UL2V  = 0, 

IF  (VAIRSP  .GT.  0.)  UL2V  = RFLGTH/ (2 . •VAIRSP) 

FMXBA  = (CL  + CLP*UL2V^WP)  • UQSL  + FMXTH 

FMYBA  = (CM  + CMQ*UL2V^WQ)  • UQSL  + FZBA^RDELCG  + FMYTH 

FMZBA  = (CN  + CNR^UL2V^WR)  • UQSL  - FYBA^RDELCG  + FMZTH 

C 

C^^  CALCULATE  HINGE  MOMENTS 
FMHl  = CH1»UQSL 
FMH2  = CH2*UQSL 
FMH3  = CH3»UQSL 
FMH4  = CH4^UQSL 
C 

C^^MOMENTS  AND  FORCES  DUE  TO  LUGS 

IF(QBURN  .LE.  0.  .AND.  RANGO  .LE.  RAIL+RLUG)  GO  TO  70 

UFZL2=FZLUG 

FYLUG  = 0. 

FZLUG  = 0. 

FMXLUG  = 0. 

FMYLUG  = 0. 

FMZLUG  = 0. 

IF  (FLG2  .GT.O. ) GO  TO  74 
FMX=0. 

FMY=0. 

FMZ=0. 

DO  6 1=1,13512 


oonou^i  oooooooooo 


IDO  = I 

IFdSNDXd)  .EQ.  1743)CALL  MCARLO(DUM  , 1 dDO) 

IFCISNDXd  ) .EQ.  1747) CALL  MCARLO(DUM,  1 ,IDO) 

6 CONTINUE 

C(13)  = 1 • 

WRITE(6  104)WP  WQ  WR 

10i<  FORMAKIH  ,50x]21HTIPOFF  RATES--ROLL  = ,F6.1,9H  PITCH  = ,F6.1, 
. 7H  YAW  = ,F6.  1 ) 

C(266U)=C(2764) 

FLG2  = 1 , 

WRITE(6,102)  T, VAIRSP,UFZL2 
WRITE(6,103)  RANGU 
103  F0RMAT(32X,  9HRANGO  = ,F6*'^) 

102  FORMAT  (1H0,36H  REAR  LUG  CLEARS  RAIL  T = ,F8.4, 

» 10HREL  VEL  = ,F8.3,16H  RAIL  FORCE  = ,F8.2) 

GO  TO  74 

70  IF  (RANGO  .LE.  RAIL)  GO  TO  72 
RZDD  = AGV 
RYDD  = AGH 

FYLUG=-(FYBA+DM ASS* AGRA V*RYDD-DMASS»(FMZBA*RLCG/FMIZ 
» -FMXBA*RLGZ/FMIX) )/( 1 . + DM ASS* ( RLGZ* »2/FMIX+RLCG*»2/FM IZ ) ) 
FZLUG  = -(FZBA  + DMASS*AGR AV* ( CFA33-RZDD ) + FMYBA* 

» RLCG*DMASS/FMIY)/d . + DMASS*RLCG*RLCG/FMIY) 

FMXLUG  = FYLUG*RLGZ 
FMYLUG  = FZLUG*RLCG 
FMZLUG  = FYLUG*RLCG 
IF  (FLG1  .GT.  0. ) GO  TO  74 
FLG1  = 1. 

WRITE(6,  101)  T,  VAIRSP,  FMYLUG 
WRITE(6,103)  RANGO 


WPTO--MONTE  CARLO  VALUE  OF  TIPOFF  ROLL  RATE 

DTLUG TIME  INCREMENT  BETWEEN  FIRST  LUG  AND 

LAST  LUG  DROP  OFF  TIME(TIPOFF  ROLL  RATE 
OCCURS  AT  LAST  LUG) 

FMX ROLL  MOMENT  THAT  GENERATES  TIPOFF  ROLL  RATE 

DTLUG=.026 

FMX=WPTO*FMIX/CRAD/DTLUG 

CONTINUE 


GO  TO  74 

72  CONTINUE 
RZDD=0. 

RYDD  = 0. 

IFCRANGO  .LT.  RAIL-. 3)  GO  TO  73 
RZDD  = AGV 
RYDD  = AGH 

73  FYLUG  = -(FYBA  + DMASS*AGRAV* ( CFA23+RYDD) ) 
FZLUG  = -(FZBA  + DMASS*AGRAV* ( CFA33-RZDD) ) 
FMXLUGr-FMXBA 

FMYLUG  = - FMYBA 
FMZLUG  = - FMZBA 
FLG1  = 0. 
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FLG2=0. 


74  CONTINUE 

C»»TOTAL  FORCE  AND  MOMENTS 
FYBA  = FYBA  + FYLUG 
FZBA  = FZBA  + FZLUG 
FMXBA  = FMXBA  + FMXLUG 
FMYBA  = FMYBA  + FMYLUG 
FMZBA  = FMZBA  + FMZLUG 

»»LAUNCH  TRANSIENTS  MOMENTS  ( 1 -YAW , 2-P ITCH , 3-ROLL  MOMENTS) 

IF(FLG2.GT.O. )GO  TO  75 

IFCVIB.LE.O. )GO  TO  75 

CALL  LTRAN(T,DELT,AMP2,FMY,WQ0, 1,2) 

CALL  LTRAN(T,DELT,AMP1 ,FMZ,WR0, 1,1) 

75  CONTINUE 

FMXBA=FMXBA+FMX 

FMYBA=FMYBA+FMY 

FMZBA=FMZBA+FMZ 


C 

RETURN 

END 
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SUBROUTINE  A3 
C*»ENGINE  MODULE 


COMMON  Ci3ii30) 


»»  INPUT  DATA 

EQUIVALENCE  ( C( 1 3 1 3) , RFXCG  ) 
EQUIVALENCE  ( C(1 3 1 ^ ) , RFYCG  ) 
EQUIVALENCE  ( C ( 1 3 1 5 ) , RFZCG  ) 
EQUIVALENCE  ( C ( 1 40 1 ) , BALPHT ) 
EQUIVALENCE  ( C ( 1 402 ) , BPH IT  ) 
EQUIVALENCE  ( C( 1 403 ) , QNALGN ) 
EQUIVALENCE  ( C ( 1 404 ) , PCFTH  ) 
EQUIVALENCE  { C ( 1 405 ) , QBURN  ) 
EQUIVALENCE  ( C( 1 4 1 4 ) , CISP  ) 
EQUIVALENCE  (C(1415),DWT  ) 

EQUIVALENCE  (C(1416),DWP  ) 

EQUIVALENCE  ( C { 1 4 1 7 ) , RDCGO  ) 
EQUIVALENCE  ( C ( 1 4 1 8 ) , RDCGF  ) 
EQUIVALENCE  ( C( 1 4 1 9 ) , FMIXF  ) 
EQUIVALENCE  ( C( 1 420 ) , FMIYF  ) 
EQUIVALENCE  ( C ( 1 42 1 ) , RLCGO  ) 
EQUIVALENCE  ( C ( 1 423 ) , FM IXO ) 
EQUIVALENCE  ( C( 1 424 ) , FMI YO) 


*»  INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  (C(2000) ,T  ) 

C 

C»»  OUTPUTS 


EQUIVALENCE  ( C ( 1 308 ) , RDELCG ) 

EQUIVALENCE  ( C ( 1 320  ) , FMXTH  ) 

EQUIVALENCE  ( C( 1 32 1 ) , FMYTH  ) 

EQUIVALENCE  ( C ( 1 322 ) , FMZTH  ) 

EQUIVALENCE  ( C ( 1 409 ) , UDWP  ) 

EQUIVALENCE  ( C ( 1 4 1 0 ) , FTHRST ) 

EQUIVALENCE  (C(14n),FTHX  ) 

EQUIVALENCE  ( C ( 1 4 1 2 ) , FTHY  ) 

EQUIVALENCE  ( C( 1 4 1 3 ) , FTHZ  ) 

EQUIVALENCE  ( C( 1 422) , RLCG  ) 

EQUIVALENCE  ( C( 1 628 ) , DMASS  ) 

EQUIVALENCE  ( C( 1 748 ) , FMIX  ) 

EQUIVALENCE  (C(1749),FMIY  ) 

EQUIVALENCE  ( C ( 1 750 ) , FMIZ  ) 

C 

C»»STATE  VARIABLES  AND  THEIR  DERIVATIVES 
EQUIVALENCE  ( C( 1 496 ) , UIMPD  ) 

EQUIVALENCE  ( C( 1 499 ) , UIMP  ) 

C»»LOOK  UP  TABLE  FOR  THRUST 

DIMENSION  NTH(2),  THA(ll),  THF(11) 

DATA  WATLAB/4HHRST/ 

DATA  NTH/1  1 , 0/ 

DATA  THA/  0.,.025,  .125,  .250,  .750,1.500,1.625,1.750,  2.00, 
*100./ 

DATA  THF/ . 1 , 1800. , 1750. , 1650. , 1600. , 1400. , 1250. , 600.,  300.,  0. 

*0./ 

C 

IF  (QBURN. GT. 0. ) RETURN 

CALL  TABLE(T,THA,THF,NTH(1 ), XF , WATLAB , FTHRST ) 

C 
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IF  (QNALGN)  20,20,10 
10  USINA=SIND(BALPHT) 

FTHX=FTHRST»COSD(BALPHT) 

FTHY=-FTHRST»USINA»SIND(BPHIT) 

FTHZ=FTHRST*U3INA»C0SD(BPHIT) 

FMXTH  = -FTHY»RFZCG  + FTHZ»RFYCG 
FMYTH  = FTHX»RFZCG  + FTHZ»RFXCG 
FMZTH  = -FTHX»RFYCG  - FTHY*RFXCG 
GO  TO  30 
20  FTHX=FTHRST 
FTHY=0. 

FTHZ=0. 

FMXTH=0. 

FMYTH=0. 

FMZTH=0. 

30  CONTINUE 

UIMPD  = FTHRST 
UDWP  = UIMP/CISP 

DMASS  = (DWT+DWP-UDWP)/32. 174 

RDELCG  = RDCGO  - (RDCGO  - RLCGF) »UDWP/DWP 

FMIX  = FMIXO  - (FMIXO-FMIXF)*UDWP/DWP 

FMIY  = FMIYO  - (FMIYO-FMIYF)»UDWP/DWP 

FMIZ  = FMIY 

RLCG  = RLCGO  + RDELCG 

IF  (FTHRST  .GT.  0.)  RETURN 

WRITE  (6  , 100)  T 

100  FORMAT  (//14H  BURNOUT  TIME= , F8 . 4 , 5H  SEC.) 
QBURNrI .0 
RETURN 
END 
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subroutine;  a3i 

COMMON  C(3830) 

DIMENSION  IPL(IOO),  ISNDX(40) 

EQUIVALENCE  (C(3634),  ISNDX(I)),  (C(3512),  13512) 

EQUIVALENCE  (C(  367),BALPHA) 

EQUIVALENCE  (C(  368),BALPHY) 

EQUIVALENCE  (C(  370),BPHIP  ) 

EQUIVALENCE  ( C( 1 308 ) , RDELCG ) 

EQUIVALENCE  ( C( 1 320 ) , FMXTH  ) 

EQUIVALENCE  ( C ( 1 32 1 ) , FMYTH  ) 

EQUIVALENCE  ( C( 1 322 ) , FMZTH  ) 

EQUIVALENCE  ( C( 1 A05 ) , QBURN  ) 

EQUIVALENCE  ( C ( 1 4 1 1 ) , FTHX  ) 

EQUIVALENCE  ( C( 1 4 1 2 ) , FTHY  ) 

EQUIVALENCE  (C( 1 4 1 3) ,FTHZ  ) 

EQUIVALENCE  (C(1415),DWT  ) 

EQUIVALENCE  ( C ( 1 4 1 8 ) , KDCGF  ) 

EQUIVALENCE  ( C (1 4 1 9 ) , FMIXF  ) 

EQUIVALENCE  ( C( 1 420 ) , FMIYF  ) 

EQUIVALENCE  ( C ( 1 628 ) , DM ASS  ) 

EQUIVALENCE  (C(1739),WP  ) 

EQUIVALENCE  (C(1743),WQ  ) 

EQUIVALENCE  (C(1747),WR  ) 

EQUIVALENCE  ( C( 1 748 ) , FMIX  ) 

EQUIVALENCE  ( C( 1 749 ) , FMIY  ) 

EQUIVALENCE  ( C(  1 750 ) , FMIZ  ) 

EQUIVALENCE  (C(2000),  T) 

EQUIVALENCE  (C(2561),N  ) 

EQUIVALENCE  ( C( 2562 ) , IPL ( 1 ) ) 

EQUIVALENCE  (C(1751),  CRAD) 

EQUIVALENCE  (C(  626),  VIB) 

EQUIVALENCE  (C(  1737),  FMX)  , (C(1741),  FMY) , (C(1745),  FMZ) 

DATA  IFLG1 ,IFLG2/0,0/ 

IPL(N  ) = 1496 
N = N + 1 
C(1499)  = 0. 

C 

IF  (QBURN  .GT.  0.)  GO  TO  10 
CRAD=57. 295778 
FMX=0. 

FMY=0. 

FMZ=0. 

WP  = 0. 

NQ  = 0. 

WR  = 0. 

BALPHA  = 0. 

BALPHY  = 0. 

BPHIP  = 0. 

MONTECARLO  THRUST  DIRECTION  ERRORS 

DO  5 I = 1 , 13512 
IDO  = I 

IFdSNDXd)  .EQ.  1313)  CALL  MCARLO  (DUM,  1,  IDO) 

IFdSNDXd ) .EQ.  131*1)  CALL  MCARLO  (DUM,  1,  IDO) 

IFdSNDXd  ) .EQ.  1315)  CALL  MCARLO  (DUM,  1,  IDO) 

IFdSNDXd)  .EQ.  1401  ) CALL  MCARLO  (DUM,  1,  IDO) 

IF(  ISNDXd  ) .EQ.  1402)  CALL  MCARLO  (DUM,  1,  IDO) 

C»*MONTE  CARLO  TIPOFF  ROLL, PITCH  AND  YAW  RATES 
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IFdSNDXd)  .EQ.  17  38)CALL  MCARLOCDUM  , 1 dDO) 
IFdSNDXd  ) .EQ.  17^6)IFLG2  = 0 
IFdSNDXd  ) .EQ.  1742)  IFLG  1=0 

5 CONTINUE 

C 

IF( VIB.LE.O. )GO  TO  6 

CALL  LTRAN(T,DELT,C(  1746) , DUM , WRO , IFLG2 , 1 ) 
CALL  LTRAN(T,DELT,C( 1742) , DUM , WQO , IfLG 1 , 2 ) 
WQ=WQO/FMIYF  »CRAD 

WR=WRO/FMIYF  »CRAD 

6 CONTINUE 
IFLG1--1 
IFLG2=1 

C 

RETURN 
10  CONTINUE 
FTHRST=0. 

FTHX=0. 

FTHY=0. 

FTHZ=0. 

FMXTH=0. 

FMYTH=0. 

FMZTH=0. 

DMASS  = DWT/32. 174 
RDELCG  = RDCGF 
FMIX  = FMIXF 
FMIY  = FMIYF 
FMIZ  = FMIYF 
RETURN 
END 
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BLOCK  DATA 
COMMON 

*/NC1Z/NCU2)  /NC2Z/NC2(M)  /NC3Z/NC3(4)  /NC5Z/NC5(M) 

»/CA1/VM1(15)  /CA2/BA2(6) ,VM2(6) 

*/CA3/BA3(7) , VM3(5)  /CA5/6A5 (7 ) , VM5 ( 3 ) 

COMMON  /CMOFZ/CMO  (6)  /CA4Z/VM4(6) 

»/CZPFZ/CZP(35)  /CZ2FZ/CZ2(35)  /CMPFZ/ CMP ( 35 ) /CM2FZ/ CM2 ( 35 ) 

*/CY4FZ/CYn(36)  /CN4FZ/CN4(36)  /CLJ4F  Z/ CL4  ( 2 1 ) /CL2FZ/CL2(2  1 ) 

«/CZDFZ/CZD1 (35)  /CMDFZ/ CMD U 35 ) 

»/CMQFZ/CMQ(36)  /CLPFZ/CLP(36)  /CLDFZ/ CLD 1 ( 2 1 ) 

•/CXOFZ/CXO(15) 

COMMON  /NC6Z/NC6(4)  /CA6/BA6 ( 6 ) , VM6 (4 ) /DXC PFZ/DXC PF ( 24 ) 

COMMON  /NC7Z/NC7(4)  /CA7/BA7 ( 9 ) , VM7 ( 3 ) /DCMFZ/DCMF( 27 ) 

COMMON  /NC8Z/NC8(2)  /CA8Z/VM8(3)  /DCMOFZ/DCMO( 3 ) 

DATA  NCl/15,0/ 

DATA  NC2/6,6,36,0/ 

DATA  NC3/7,5,35,0/ 

DATA  NC5/7 , 3, 21 , 0/ 

DATA  VM 1/0.0  ,0.4  ,0.6  ,0.7  ,0.8  ,0.85,0.9  ,1.0  ,1.1  ,1.2  , 

» 1 . i , 1 . 4 , 1 . 6 , 1 . 8 , 2 . 4 / 

DATA  VM2/0. 0,0. 7, 0.9, 1.1, 1.4, 2.0/ 

DATA  VM3/  .5,  .85,  .95,1.05,1.25/ 

DATA  VM4/  .5,  .85,  .95,1.05,1.25,2./ 

DATA  VM5/  .5,  .95,  1.25/ 


DATA  BA2/  0 . , 
DATA  BA3/  0 . , 
DATA  BA5/  0 . , 

4. , 8.  , 
2.  , 4.  , 
2.  , 4.  , 

12. , 16. ,20./ 

8. , 12. , 16. ,20./ 

8.,  12. ,16. ,20./ 

DATA  CXO/.308, 
« .752, 

.293, .295, .299, .313,  . 
.791 , .850, .859, .832/ 

330, .352, .492, 

DATA  CMO  / 

* + 0.  10  , +0.25  , 

+0.00  , 

-0.15  ,-0.05  , 

.00  / 

DATA  CZP/ 

» 0.00  , 0.20  , 

0.50  , 

1.30  , 2.25  , 

3.25  , 

4.30 

f 

» 0.00  , 0.20  , 

0.50  , 

1.35  , 2.35  , 

3.40  , 

4.45 

* 0.00  , 0.25  , 

0.60  , 

1.45  , 2.45  , 

3.55  , 

4.70 

f 

* 0.00  , 0.30  , 

0.65  , 

1.50  , 2.50  , 

3.70  , 

4.90 

» 0.00  , 0.30  , 

0.65  , 

1.50  , 2.50  , 

3.70  , 

5.00 

/ 

DATA  CMP/ 

»+0 .10  ,+0.40  , 

+0.40  , 

+0.00  ,-0.65  , 

-1.15  , 

-1.50 

9 

•+0.25  ,+0.45  , 

+0.45  , 

+0.10  ,-0.50  , 

-0.80  , 

-0.85 

9 

»+0.00  ,+0.25  , 

+0.20  , 

-0.30  ,-0.90  , 

-1.00  , 

-0.70 

9 

»-0. 15  , +0.00  , 

+0.00  , 

-0.35  ,-0.90  , 

-1.10  , 

-0.50 

9 

»-0.05  ,+0.10  , 

+0.10  , 

-0.20  ,-0.55  , 

-0.45  , 

-0.50 

/ 

DATA  CZDl/ 

» .053  , .049  , 

.050  , 

.055  , .056  , 

.066  , 

.069 

9 

» .054  , .051  , 

.050  , 

.053  , .057  , 

.062  , 

.061 

9 

» .052  , .046  , 

.053  , 

.055  , .062  , 

.065  , 

. 066 

9 

* .055  , .053  , 

.053  , 

.054  , .056  , 

.060  , 

.061 

9 

» ,048  , .046  , 

.045  , 

.045  , .047  , 

.050  , 

.051 

/ 

DATA  CMD1/ 

195  , 185  , 

-. 190  , 

-.195  ,-.205  , 

-.230  , 

-.245 

9 

»-.205  ,-.195  , 

-. 190  , 

-.195  ,-.215  , 

-.230  , 

-.240 

9 

*-.205  ,-.200  , 

-.210  , 

-.225  ,-.245  , 

-.255  , 

-.270 

9 

*-.220  ,-.210  , 

-.210  , 

-.220  ,-.225  , 

-.240  , 

-.255 

9 

*-.190  ,-.185  , 

-. 180  , 

-.180  , -. 185  , 

-.205  , 

-.220 

/ 

DATA  CLD1/ 

» .0235,  .0240, 

.0255, 

.0285,  .0325, 

.0320, 

.0345, 

* .0270,  .0280, 

.0295, 

.0325,  .0355, 

.0370, 

.0370, 

* .0285,  .0300, 

.0315, 

.0335,  .0370, 

.0375, 

.0345/ 

r 


A'-' 


I 

r 

h 


DATA  CYA/ 


-0.00, 

-0.05, 

-0.14, 

-0.30, 

-0.55, 

-1.05, 

-0.00, 

-0.06, 

-0.16, 

-0.32, 

-0.57, 

-1.07, 

* 

-0.00, 

-0.07, 

-0.18, 

-0.35, 

-0.63, 

-1.10, 

-0.00, 

-0.10, 

-0.23, 

-0.45, 

-0.80, 

-1.40, 

* 

-0.00, 

-0.08, 

-0.20, 

-0.40, 

-0.70, 

-1.27, 

* 

-0.00, 

-0.06, 

-0. 15, 

-0.30, 

-0.60, 

-1.13/ 

DATA  CN4/ 

0.00, 

0.05, 

0.  15, 

0.43, 

0.97, 

1.85, 

0.00, 

0.05, 

0.  12, 

0.48, 

1.05, 

1.92, 

* 

0.00, 

0.07, 

0.23, 

0.55, 

1.17, 

2.  12, 

ft 

0.00, 

0.10, 

0.30, 

0.80, 

1.65, 

3.05, 

ft 

0.00, 

0.06, 

0.25, 

0.70, 

1.55, 

2.95, 

ft 

0.00, 

0.04  , 

0.20, 

0.65, 

1.50, 

2.85/ 

DATA  CL4/ 

ft 

.000  , 

.002  , 

.005  , 

.016  , 

.036  , 

.067  , 

.110 

1 

ft 

.000  , 

.001  , 

.002  , 

.006  , 

.018  , 

.042  , 

.020 

ft 

.000  , 

.000  , 

.000  , 

.003  , 

.013  , 

.009  , 

-.013 

/ 

DATA  CL2/ 

ft 

.000  , 

.005  , 

.013  , 

.034  , 

. 066  , 

.062  , 

.010 

1 

ft 

.000  , 

.004  , 

.010  , 

.034  , 

.080  , 

. 086  , 

.055 

f 

ft 

.000  , 

.003  , 

.007  , 

.023  , 

.044  , 

.030  , 

-.010 

/ 

DATA  CZ2/ 

ft 

.00  , 

.02  , 

.05  , 

.25  , 

.55  , 

1.00  , 

1.58 

9 

ft 

. 00  , 

.02  , 

.06  , 

.25  , 

.58  , 

1.04  , 

1.63 

9 

ft 

.00  , 

.02  , 

.06  , 

.25  , 

.55  , 

1.00  , 

1.58 

9 

ft 

.00  , 

.02  , 

.06  , 

.25  , 

.55  , 

1.00  , 

1.54 

9 

ft 

.00  , 

.02  , 

.06  , 

.25  , 

.52  , 

.83  , 

1.12 

/ 

DATA  CM2/ 

ft 

-0.00  , 

-0.05  , 

-0.10  , 

-0.40  , 

-1.05  , 

-2.05  , 

-3.40 

9 

ft 

-0.00  , 

-0.05  , 

-0.10  , 

-0.40  , 

-1.05  , 

-2.20  , 

-3.75 

9 

ft 

-0.00  , 

-0.00  , 

-0.05  , 

-0.30  , 

-0.95  , 

-2.10  , 

-3.50 

9 

ft 

-0.00  , 

-0.05  , 

-0.10  , 

-0.45  , 

-1.15  , 

-2.45  , 

-3.90 

9 

ft 

-0.00  , 

-0.05  , 

-0.10  , 

-0.55  , 

-1.35  , 

-2.40  , 

-3.6 

/ 

DATA  CMQ/ 

ft 

-1.75, 

-2.74, 

-3.06, 

-3.07, 

-2.88, 

-2.55, 

ft 

-1.75, 

-2.73, 

-3.02, 

-3.03, 

-2.87, 

-2.57, 

ft 

-1.75, 

-2.68, 

-2.98, 

-3.00, 

-2.88, 

-2.63, 

ft 

-1.75, 

-2.74, 

-3. 1M, 

-3.30, 

-3.22, 

-3.26, 

ft 

-1.75, 

-2.74, 

-3.  14, 

-3.30, 

-3.25, 

-3.3^, 

ft 

-1.75, 

-2.79, 

-3.20, 

-3.38, 

-3.50, 

-3.59/ 

DATA  CLP/ 

ft 

- . 038 , 

-.057, 

-.072, 

-.079, 

-.081 , 

-.076, 

ft 

-.038, 

-.057, 

-.072, 

-.079, 

-. 081  , 

-.077, 

ft 

-.038, 

-.057, 

-.072, 

-.079, 

-.082, 

-.079, 

ft 

-.042, 

-.  061  , 

-.078, 

-.093, 

-.106, 

-.117, 

ft 

-.  041  , 

-.059, 

-.078, 

-.090, 

-.103, 

-.113, 

ft 

-.038, 

-.053, 

-.068, 

-.083, 

-.099, 

-.114/ 

DATA  NC6/6 , 4 , 24 , 0/ 

DATA  BA6/0. , 2 . , 4 . , 8 . , 1 2 . , 1 6 . / 

DATA  VM6/. 85,  .95,  1.05,  1.25/ 

DATA  DXCPF/ 

» .0000,  .0000,  .0000,  .0000,  .0000,  .0000, 

» .0000, .0000, .0000, .0055, .0075, .0085, 

». 01 40, .0155, .0125, .0120, .0115, .01 10, 

* .04  15,  .04  10,  .0390,  .0280,  .0190,  .0150/ 

DATA  NC7/9,  ',27,0/ 

DATA  BA7/0.  C, 2. 0, 4. 1 , 6. 1 , 8. 1 , 10. 2, 13. 2,  16. 3,  19. 3/ 
DATA  V:-17/.5,  .95,1.25/ 

DATA  DCMF/ 
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T 


*. 01 39, .0494, . 1190, .2259, .285b, .3479, .4598, .4968, .6577, 

* .0510, .0848,  . 1798, .2990, .3764, .4833, .5519, .61 17, .7500, 
» .0276, .0826, .1630, .2792, . 3381 , . 4 1 57 , . 4995 , . 54 36 , .5379/ 
DATA  NC8/3,0/ 

DATA  VM8/.5, .95, 1.25/ 

DATA  DCMO/ .0139, .0510, .0276/ 

END 


n o 


SUBROUTINE  Cl 
COMMON  C(3830) 

DIMENSION  BDELTC(4) ,VAR(101  ) 

C 

C»»INPUT  DATA 

EQUIVALENCE  (C(  860), TDY  ) 
EQUIVALENCE  (C(  861),GBIAS  ) 
EQUIVALENCE  (C(  862), GN  ) 
EQUIVALENCE  (C(  863), WN2  ) 
EQUIVALENCE  (C(  86^0, WN1  ) 
EQUIVALENCE  (C(  865), WL  ) 
EQUIVALENCE  (C(  866),WLXX1  ) 
EQUIVALENCE  (C(  867),WLXX2  ) 
EQUIVALENCE  (C(  868),WLJK1  ) 
EQUIVALENCE  (C(  869),WLJK2  ) 
EQUIVALENCE  (C(  870), HJK  ) 
EQUIVALENCE  (C(  871), WXX  ) 
EQUIVALENCE  {C(  872), DXX  ) 
EQUIVALENCE  (C(  873), WJK  ) 
EQUIVALENCE  (C(  87^1), DJ  ) 
EQUIVALENCE  (C(  875), GXX  ) 
EQUIVALENCE  (C(  876), GJK  ) 
EQUIVALENCE  (C(  877), RES  ) 
EQUIVALENCE  (C(  878), QDN  ) 
EQUIVALENCE  (C(  879), QUP  ) 
EQUIVALENCE  (C(  890), HXX  ) 
EQUIVALENCE  (C(  892),QBIAS  ) 
EQUIVALENCE  (C(  893),RBIAS  ) 
EQUIVALENCE  (C(  899),OPTC1  ) 
EQUIVALENCE  (C(  947), GNS  ) 
EQUIVALENCE  (C(  948), WS1  ) 
EQUIVALENCE  {C(  949), WS2  ) 


•‘INPUTS  FROM  OTHER  MODULES 

EQUIVA!,ENCE  (C(  77),SPHI  ) 

EQUIVALENCE  (C(  87),STHT  ) 

EQUIVALENCE  (C(  97),SPSI  ) 

EQUIVALENCE  (C(  353),BPH1  ) 

EQUIVALENCE  (C(  354),BTH2  ) 

EQUIVALENCE  (C(  355),BPS1  ) 

EQUIVALENCE  (C(  403),WLAMQ  ) 
EQUIVALENCE  (C(  407),WLAMR  ) 
EQUIVALENCE  (C(  461), CAGE  ) 
EQUIVALENCE  (C(  462),TKRZ  ) 

EQUIVALENCE  (C(  463),TKRy  ) 

EQUIVALENCE  (C(1233),BDR  ) 

EQUIVALENCE  (C(1747),WR  ) 

EQUIVALENCE  (C(1743),WQ  ) 

EQUIVALENCE  (C(1739),WP  ) 

C 

C*»INPUTS  FROM  MAIN  PROGRAM 

EQUIVALENCE  (C(2000) ,T  ) 

C 

C**  STATE  VARIABLE  OUTPUTS 

EQUIVALENCE  (C(  800),WLQSDD) 
EQUIVALENCE  (C(  803),WLQSP  ) 
EQUIVALENCE  (C(  804),WLQSD  ) 
EQUIVALENCE  (C(  807),WLQS  ) 

EQUIVALENCE  (C(  808),WLQSSD) 


EQUIVALENCE  (C(  BID.WLQSS  ) 

EQUIVALENCE  (C(  812),WLRSDD) 

EQUIVALENCE  (C(  815),WLRSP  ) 

EQUIVALENCE  (C(  816),WLKSD  ) 

EQUIVALENCE  (C(  819),WLRS  ) 

EQUIVALENCE  (C(  820),WLRSSD) 

EQUIVALENCE  (C(  823),WLRSS  ) 

EQUIVALENCE  (C(  824),BLQSSD) 

EQUIVALENCE  (C(  827),BLQSS  ) 

EQUIVALENCE  (C(  82&),BLRSSU) 

EQUIVALENCE  (C(  831),BLRSS  ) 

EQUIVALENCE  (C(  832),BJJSDD) 

EQUIVALENCE  (C(  835),BJJSP  ) 

EQUIVALENCE  (C(  836),BJJSD  ) 

EQUIVALENCE  (C(  839),BJJS  ) 

EQUIVALENCE  (C(  840),BKKSDD) 

EQUIVALENCE  (C(  843),BKKSP  ) 

EQUIVALENCE  (C(  844),BKKSD  ) 

EQUIVALENCE  (C(  847),BKKS  ) 

EQUIVALENCE  (C(  848),BXXSDD) 

EQUIVALENCE  (C(  8!3l),BXXSP  ) 

EQUIVALENCE  (C(  852),BXXSD  ) 

EQUIVALENCE  (C(  855),BXXS  ) 

EQUIVALENCE  (C(  931),BJSSD  ),  (C(  934),BJ3S  ) 

EQUIVALENCE  (C(  935),BKSSD  ),  (C(  93B),BKSS  ) 

EQUIVALENCE  (C(  950),SNP2  ),  (C(  953),SNP1  ),(C(  95b),SNPU 

EQUIVALENCE  (C(  957),SNQ2  ),  (C(  960),SNQ1  ),(C(  963),SNQO 

EQUIVALENCE  (C(  954),SNR2  ),  (C(  967),SNR1  ),(C(  970),SNR0 

EQUIVALENCE  (C(  971),BPC2  ),  (C(  974),BPC1  ),(C(  977),BPC0 

EQUIVALENCE  ( C ( 903 ) , H 1 3P ) , ( C( 904 ) , H 1 3M ) 

EQUIVALENCE  (C(905) ,H24P) ,(C(906) ,H24M) 

EQUIVALENCE  ( C( 907 ) , CDRFT 1 ) ,(C(908) ,CDRFT2) 

EQUIVALENCE  ( C(  909  ) , CDRFTlf ) 

EQUIVALENCE  ( C( 9 84 ) , CDRFTX ) 

EQUIVALENCE  ( C ( 1 676 ) , ANGX ) 

EQUIVALENCE  (C(978) .BDRFTD) , (C(981 ) ,BDRFT) 

EQUIVALENCE  (C(985) .NLMTI) ,(C(986) ,NLMT2) 

EQUIVALENCE  (C(987) .BJJSSS) ,(C(988) .BKKSSS) 

EQUIVALENCE  ( C{ 9 89 ) , BXXSSS ) 

EQUIVALENCE  (C(990) .BJJSSL) , (C(991 ) .BKKSSL) 

EQUIVALENCE  (C(630) ,BJSDD) , (C(534) ,BJSD) , ( C ( 5 37 ) , B JS ) 
equivalence  (C(538) , BKSDD ) , ( C( 542 ) , BKSD) , ( C( 545 ) , BKS ) 
EQUIVALENCE  (C(546) .BXSDD) , ( C( 550 ) , BXSD ) , ( C( 553 ) , BXS ) 
EQUIVALENCE  (C(533) , C J3D ) , ( C ( 54 1 ) , CKSD ) , ( C( 549 ) , CXSD ) 
EQUIVALENCE  (C(942),WL2) 

EQUIVALENCE  (C{943),DJ2) 

EQUIVALENCE  (C{944),WJ2) 

EQUIVALENCE  (C(945),DX2) 

EQUIVALENCE  (C(946),WX2) 

EQUIVALENCE  ( C( 2965 ) , VA R ( 1 ) ) 

C 

C»*0UTPUT3 

EQUIVALENCE  (C(  856 ) , BDELTC ( 1 ) ) 

C 

CM*0THER  OUTPUTS 

EQUIVALENCE  (C(  880),BPHIS  ) 

EQUIVALENCE  ( C( 5 1 8 ) , B 1 3SS ) 

EQUIVALENCE  ( C ( 5 1 9 ) , B24SS ) 

EQUIVALENCE  (C(  881), BJJ  ) 

EQUIVALENCE  (C(  882), BKK  ) 


o o 


WLQSD  = WLQSP 
WLRSD  = WLRSP 

WLQSDD  = WN2»(WN2»(WLAMQ  - WLQS)  - 2.»WLQSD) 

WLRSDD  = WN2*(WN2*(WLAMR  - WLRS)  - 2.»WLRSD) 
wgc  = GN»(WLgsD/wL  + wLgs)  + geiAS  + gbias 
WRC  = GN»(WLRSD/WL+WLRS)  + RBIAS 
IF  (TKRZ.GT.O.  .AND.  T.GT.TDY)  GO  TO  4 
WLOSDD  = 0. 

wgc  = gBIAS  + GBIAS  + goN 

IFCCAGE  .GT.  0.  .AND.  T.GT.  TDY)  WgC  = WLAMO  + OBIAS  + GBIAS 

4 IF  (TKRY  .GT.  0. ) GO  TO  5 
WLRSDD  = 0. 

WRC  = RBIAS 

IF(CAGE  .GT.  0.)  WRC  = WLAMR  + RBIAS 

5 CONTINUE 

WLOSSD  = WN1«(W0C  - WLgSS) 

WLRSSD  r WN1»(WRC  - WLRSS) 

IF(WN1  .GT.  0. ) GO  TO  3 
wLoss  = wgc 

WLRSS  = WRC 
3 BLOSSD  = WLOSS 
BLRSSD  = WLRSS 


»*RATE  GYRO  DYNAMICS  AND  LIMITING 
BDRFTD=(CDRFT1*ANGX+CDRFT2) 

BTHTS=-BTH2+BDRFT 

BPSIS  = -BPSUCDRFTY»BDRFT 

BPHIS=-BPH1+CDRFTX*BDRFT 

BPHISD  = WP  - (W0»C0SD(-BPH1 ) -WR»SIND(-BPH 1 ) ) 

* »SIND(-BPS1 )/C0SD(-BPS1 ) 

BPHS  = BPHISD  / WLXX2  + BPHIS 
6 IFCGNS  .LE.  0. ) GO  TO  8 

SNP2  = WS1*WS2»(GNS»SPHI-SNP0)  - ( WS1 +WS2 ) »SN P 1 
SNg2  = WS1»WS2»(GNS*STHT-SNQ0)  - ( WS 1 +WS2 ) “SNO 1 
SNR2  = WS1*WS2*(GNS*SPSI-SNR0)  - (WS1 +WS2) “SNR  1 
BPHS  = BPHS  -SNP1 
BTHTS  = BTHTS  - SN01 
BPSIS  = BPSIS  - SNR1 
8 CONTINUE 
BXX  = BPHS 
BTSS  = BTHTS 
BP3S  = BPSIS 

C»*«»*specIAL  CASE  - PROGRAMMED  FLIGHT 
IF(0PTC1  . LE.  0. ) GO  TO  9 
BLOSSD  : OBIAS 
BLRSSD  = 0. 

BDC  = 0. 

BT=0. 


BP  = 0. 

IF(T.GE. 1 . 0000  . AND. 
IF(T.GE.4.2  .AND. 
IF(T.GE.7.6000  .AND. 


T.LE.3.2000)BDC=  5. 
T.LE.6.4000)BT=  5. 
T.LE.9.9000)BDC=-5. 
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IFd.GE.  1 1 .000  .AND.  T . LE  . 1 3 . 1 00 ) BP  = -5  . 

IFd.GE.  15.200  .AND.  T . LE  . 1 7 . 300  ) BDC=  5. 

IFd.GE.  18.320  .AND.  T . LE  . 20 . 560  ) BT  = 5. 

IFd.GE. 21 .545  .AND.  T . LE  . 23 . 675  ) BDC  = -5  . 

IFd.GE. 24. 770  .AND.  T . LE  . 26 . 9 1 0 ) BP  = -5  . 

C(520)=-BPC0+BP-BT 

BPC2=18.  18*20.57«(BDC-BPC0)-(18. 1 8+20 . 57 ) *BPC  1 
BXX  = BXX  + BPCO 
BTSS=BTSS-BT 
BPSS=BPSS-BP 

^‘SUMMATION  OF  RATE  DAMPING  AND  GUIDANCE  SIGNALS  AND  THEIR  DERIVATIVES 
9 BJJ  = (BLRSS  - BPSS)  - (BLQSS  - BTSS) 

BKK  = -(BLRSS-BPSS)  - (BLQSS-BTSS) 

C 

C»»GUIDANCE  SIGNAL  SHAPING  AND  LIMITING 
BXXSD  = BXXSP 
BJJSD  = BJJSP 
BKKSD  = BKKSP 

BXXSDD  = WXX*(WXX»(BXX  - BXXS ) - 2 . »DXX* BXXSD ) 

, BJSD=CJSD 

I BKSD=CKSD 

' BX3D=CXSD 

^ HSAT=23. 

; IF(ABS(BJJS) .LT.HSAT)GO  TO  20 

BJJS=SIGN(HSAT,BJJS) 

VAR(NLMT1+1 )=BJJS 
IF( BJJS*BJJSD.GT.O. 0)BJJSD=0.0 
20  BJJSDD=WJK*( WJK*(GJK»BJJ-BJJS)-2.»DJK»BJJSD) 

IF(ABS(BKKS) .LT.HSAT)GO  TO  25 
BKKS=SIGN(HSAT,BKKS) 

VAR(NLMT1+3)  = BKKS 

r IF(BKKS*BKKSD.GT.O.O)BKKSD=0.0 

25  BKKSDD=WJK»(WJK»(GJK»BKK-BKKS)-2.»DJK*BKKSD) 

BXXSS=GXX*( (BXXSDD+(WLXX1+WLXX2)«BXXSD)/( WLXX1»WLXX2)+BXXS) 
BJJSS:BJJSD/WLJK1+BJJS 

IF( ABS(BJJSS) .GT.HSAT)BJJSS=SIGN(HSAT,BJJSS) 

BKKSS=BKKSD/WLJK 1+BKKS 

IF(  AB3(BKKSS) .GT.HSAT)BKKSS=SIGN(HSAT, BKKSS) 

C **  HIGH  FREQUENCY  SHAPINF  OPTION 

IF(WX2»WJ2.LE.O. )G0  TO  10 
IF(ABS(BKS) .LT.HSAT)GO  TO  30 
BKS=SIGN(HSAT,BKS) 

VAR(NLMT2+3)=BKS 
IF( BKS»BKSD.GT. 0. 0)BKSD=0. 0 
30  BKSDD=WJ2*(WJ2*(BKKSS-BKS)-  2.»DJ2*BKSD) 

IF(AB3(bJS) .LT. HSAT)GO  TO  35 
BJS:SIGN(HSAT,BJS) 

VAK(NLMT2+1 )=BJ3 
IF(BJ3*BJ3D.GT.0.0)BJSD=0.0 
35  BJ3DD=WJ2*(WJ2»(BJJSS-BJS)-  2.*DJ2»BJSD) 

BX3DD:WX2*( WX2»(BXXSS-BXS)-2.»DX2*BXSD) 

BKKSSS=BKSD/WLJK2+BKS 

IF(  ABSCBKKSSS) .GT.HSAT)BKKSSS  = SIGN(HSAT,BKKSSS) 
BJJSSS=BJSD/WLJK2+BJ3 

IF( ABS(BJJSSS) .GT.HSAT)BJJSSS=SIGN(HSAT,BJJSSS) 

BXXS3S=BXS 
10  BJJ3SL=BJJSSS 
Bi<KSSL  = BKK33S 

IF(3JJSSL.GT.H13P)BJJSSL=H13P 
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IF (BJJSSL.lt. HI 3M)BJJSSL=H 13M 

IF( BKKSSL.GT.H24P)BKKSSL=H24P 

IF(BKKSSL.LT.H24M)BKKSSL=H24M 

B13SS=BJJSSL 

B24SS=BKKSSL 

••COMMANDS  TO  ACTUATORS 

BJSSD  = 20.»(B13SS-BJSS) 

BKSSD  = 20.*(B24SS-BKSS) 

B13SS  = BJSSD/125.+BJSS 

B24SS  = BKSSD/125.+BKSS 

BDELTC( 1 )=B13SS+BXXSSS 

BDELTC(2)=B24SS+BXXSSS 

BDELTC(3)=B13SS-BXXSSS 

BDELTC(4)zB24SS-BXXSSS 

RETURN 

END 


t 
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SUBROUTINt;  ClI 
COMMON  C(3830) 

DIMENSION  IPL(IOO) 

EQUIVALENCE  (C(25b1),N  ) 

EQUIVALENCE  ( C( 2562 ) , IPL (1 ) ) 

EQUIVALENCE  ( C( 985 ) , NLMT 1 ) , ( C( 986 ) ,NLMT2) 
C 

IPL(N  ) = 800 
IPL(N+1)  = 804 
IPL(N+2)  = 808 
IPL(N+3)  = 812 
IPL(N+4)  = 816 
IPL(N+5)  = 820 
IPL(N+6)  = 824 
IPL(N+7)  = 828 
IPL(N+8)  = 832 
NLMT1=N+9 
IPL(N+9)  = 836 
IPL(N+10)  = 840 
IPL(N+1 1 ) = 844 
IPL(Nf12)  = 848 
IPL(Nt-13)  = 852 
N = N+14 
C(803)  = 0. 

C{807)  = 0. 

C(81  1 ) = 0. 

i C(815)  = 0. 

! C(819)  = 0. 

1 C(823)  = 0. 

C(827)  = 0. 

‘ C(831 ) = 0. 

' C(835)  = 0. 

C(839)  = 0. 

C(843)  = 0. 

C(847)  = 0. 

' C(851 ) = 0. 

C(855)  = 0. 

C(  811)  = C(  378)  + C (861 ) 

C(  823)  = C(  879) 

C(  831  ) = -C( 1 143) 

C(  847)  =-C(  831) 

C(  839)  = C(  831) 

CCC  PROGRAMMER 

IF(C(899) .LE.O. )G0  TO  9 
IPL(N)=971 
IPL(N+1 )=974 
N = N+2 
C(974)=0. 

C(977)=0. 

; 9 IF(C(949)  .LE.  0. ) GO  TO  10 

[ C»»GYRO  POT  NOISE 

IPL(N  ) = 950 

I IPL{N+1)  = 953 

IPL(N+2)  = 957 

■ IPL(N+3)  = 960 

IPL(N+4)  = 964 

'I  IPL(N+5)  = 967 

• N = N + 6 

C(  953)  = 0. 

L 
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C(  956)  = 0. 

C(  960)  = 0. 

C(  963)  = 0. 

C(  967)  = 0. 

C{  970)  = 0. 

10  CONTINUE 

IF(C(944)»C(946) .LE.0.0)G0  TO  20 

IPL(N)=530 

IPL(N+1 )=534 

NLMT2=N+1 

IPL(N+2)=538 

IPL(N+3)=542 

IPL(N+4)=546 

IPL(N+5)=550 

N=N+6 

C(533)=0.0 
C(541  ) = 0.0 
C(549)=0. 0 
C(537)=0.0 
C(545)=0.0 
C(553)=0.0 
20  CONTINUE 

IPL(N  ) = 931 
IPL(N+1 ) = 935 
N = N + 2 
C(  934)  = 0. 

C(  938)  = 0. 

IPL(N)=978 

N=N+1 

C(981  ) = 0.0 

RETURN 

END 
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SUBROUTINE  C^l 


C 

C»»  HELFIRE  SIMPLIFIED  ACTUATOR  MODEL 
non  - LINEAR  MODEL  ***»»* 


C 


COMMON  C(3830) 

DIMENSION  BDSS(4) ,BDS(4) ,BDSD(4) 

DIMENSION  BDELTD(4) ,BDELT(4) , BDELTC ( 4 ) , VAR ( 1 0 1 ) 
DIMENSION  BDLT(4),  BDT(4) 

DIMENSION  WDS2D(4),  WDS2(4),  WDS1D(4),  WDS1(4) 
DIMENSION  IPL( 101  ) 

DIMENSION  NC2(2),  CB2(6),  CHAF(6) 

DIMENSION  G1(4),G2(4),G3(4),W1(4),ZN(4),WN(4) 
DIMENSION  H1(4),  H2(4),  BH(4) 

DIMENSION  CB1(6),  CHDU(6),  CHDL(6) 

DIMENSION  AIH(4) 

EQUIVALENCE  ( C( 52 1 ) , AIH ( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 1 6 ) , G3 ( 1 ) ) 

EQUIVALENCE  ( C(1 1 20 ) , G 1 ( 1 ) ) 

EQUIVALENCE  ( C( 1 1 24 ) , ZN (1 ) ) 

EQUIVALENCE  ( C( 1 1 28 ) , WN ( 1 ) ) 

EQUIVALENCE  ( C(  11  32 ) , W 1 ( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 36 ) , G2 ( 1 ) ) 

EQUIVALENCE  ( C( 1 1 48  ) , H U 1 ) ) 

EQUIVALENCE  ( C(1 1 52 ) , H2( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 56 ) , BH ( 1 ) ) 


C 

C»»INPUT  DATA 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 


(C( 1140) .OPTACT) 
(C(1141),BDP  ) 
(C(1142),BDQ  ) 
(C(1143),BDR  ) 
(C(1144),EFF  ) 
(C(1145),HX  ) 
(C( 1 14fa) ,BDB  ) 
(C( 1 147) ,FMbS  ) 
(C(1306) .RFAREA) 
(C( 1 307) ,RFLGTH) 


C 

C*»INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  ( C( 0203 ) , PDYNMC) 
EQUIVALENCE  (C(  204),VMACH  ) 
EQUIVALENCE  (C(  367),BALPHA) 
EQUIVALENCE  (C(  368),BALPHY) 
EQUIVALENCE  (C(  377),BALPD  ) 
EQUIVALENCE  (C(  378),BALYD  ) 
EQUIVALENCE  (C(  856 ) , BDELTCC 1 ) ) 
EQUIVALENCE  (C(1254),  DELTB) 
EQUIVALENCE  ( C ( 1 1 92 ) , BDT ( 1 ) ) 
EQUIVALENCE  ( C ( 1 1 96 ) , BDLT ( 1 ) ) 
EQUIVALENCE  ( C ( 525 ) , BDSS ( 1 ) ) 
EQUIVALENCE  ( C ( 1 3 1 0 ) , FMH2  ) 
EQUIVALENCE  ( C(  1 3 1 1 ) , FMH3  ) 
EQUIVALENCE  ( C ( 1 3 1 2 ) , FMH4  ) 

C 

C»*INPUTS  FROM  MAIN  PROGRAM 

EQUIVALENCE  (C(2000),T  ) 

EQUIVALENCE  (C(2013),DOC  ) 

EQUIVALENCE  (C(2561),N  ) 
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EQUIVALENCE  ( C( 2562 ) , IPL (1 ) ) 


DATA  WATLB1/4HCH14/  , WATLB2/4HCH23/  , WATLB3/4HFMHA/ 

DATA  NC2/6,0/ 

DATA  CB2/  .00,  .50,  .85,  1.05,  1.^0,  1.60/ 

DATA  CHAF/  0.  , .1,  .4,  1.6,  3-1,  3.6/ 

DATA  CB1/.0000, .8500, .9500, 1.050,1.250, 1.600/ 

DATA  CHDU/.0007, .0007, .0007, .0020, .0020, .0020/ 

DATA  CHDL/.0007, .0007, . 00 1 8 , . 00 1 8 , . 00 1 8 , . 00 1 8/ 

C*»STATE  VARIABLE  OUTPUTS 

BDELTC. 1 ) = BDELTCC 1 ) - 
BDELTC(2)  = BDELTC(2)  - 
BDELTC(3)  = BDELTC(3)  + 

BDELTC(4)  = BDELTC(4)  + 

BDELT( 1 )=C( 1 103) 

BDELT(2)=C(1 107) 

I BDELT(3)=C( 1 1 1 1 ) 

BDELT(4 )=C( 1115) 

BDSd  )=C(  1087) 

BDS{2)=C( 1091 ) 

BDS(3)=C(1095) 

BDS(4)=CC 1099) 

WDS2  ( 1 ) = C( 1 153) 

WDS2  (2)  = C( 1 167) 

WDS2  (3)  = C(1171) 

> WDS2  (4)  = C( 1 175) 

WDS1  (1)  = C(1179) 

WDS1  (2)  = C( 1 183) 

WDS1  (3)  = C(  1 187) 

WDS1  (4 ) = C( 1 191 ) 

C»*ACTUATOR  DYNAMICS 
XK=0. 

VM  = AMINUVMACH,  1.4) 

CALL  TABLE(VM,CB1 ,CHDU,NC2(1 ) , XK , WATLB 1 , CH 1 4 ) 

CALL  TABLE(VM,CB1 ,CHDL,NC2(1 ) , XK , WATLB2 , CH23 ) 

CALL  TABLE (VM,CB2,CHAF,NC2(1 ) , XK , WATLB3 , FMHA ) 

FM14  : CH14*PDYNMC»RFLGTH«RFAREA*12. 

FM23  = CH23*PDYNMC»RFLGTH»RFAREA*12. 

DO  30  1=1,4 

J = (I+1)/2 
FMHD  = FM14 

IF(IABS((2»I-5)/2)  .LE.  0)  FMHD  = FM23 
FMH=FMHD*BDELT(I )+FMHA*(BALPHA+BALPHY»(-1 )»*I) 

DDE  = WDSUI  )-FMH/G2(I ) 

WDS2D(I )=WN(I )*CG3(I )»BDE-WDS2(I ) ) 

BDELTDCI )=WDS2D(I )/Wl (I )+WDS2(I ) 

BDSDd )=65.*(BDELTD(I )/125.+BDELT(I )-BDS(I )) 

BDSSCI )=BD3D(I )/125.+BDS(I ) 

BDH=G1 (I )*( BDELTCC l)-BDSS(I)) 

AIH(I)=BDH 

IF(BDH.LT.-H2(I ) )BDH=-H2(I ) 

IFCBDH.GT.  H1(I))BDH=  HKI) 

WDSIDCI )=W1 (I )»(BDH-WDS1 (I) ) 

IFCBDTCI ) .LT.BDELTCI )-BH(I))BDT(I )=BDELT(I)-BH(I ) 

IFCBDTd  ) .GT.BDELTCI  ) + BH(I  ))BDT(I  ) = BDELT(I  ) + BH(I ) 

BDLTCI  ) = BDTd  ) 

C»*SURFACE  POSITION  LIMITER 

IF(  ( ABSCBDELTd  ) ) .GT.  19.  ) . AND .(  BDELTD  (I ) *BDELT  (I  ).  GT . 0 .))  BDELTDCI ) 


BDP  + BDQ  - BDR 
BDP  + BDQ  -*■  BDR 
BDP  + BDQ  - BDR 
BDP  + BDQ  + BDR 
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30  CONTINUE 
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C( 108^)=BDSD( 1 ) 

C( 1038)=BDSD(2) 

C( 1092)=BDSD(3) 

C(1096)=BDSD(4) 

C( 1 103)  = BDELTCI  ) 

C(1107)  = BDELT(2) 

C( 1 1 1 1 ) = BDELT(3) 

C(1115)  = BDELT(4) 

C .....  . . 

C»*OUTPUT  DERIVATIVES  OF  STATE  VARIABLES  TO  INTEGRATION 
C(  1 100)  = BDELTDd  ) 

C(1104)  = BDELTD(2) 

C(1108)  = BDELTD(3) 

C(1112)  = BDELTD(4) 

C( 1 160)  = WDS2D( 1 ) 

C( 1164)  = WDS2D(2) 

C(1168)  = WDS2D(3) 

C(1172)  = WDS2D(4) 

C(  1 176)  = WDSIDd  ) 

C( 1 180)  = WDS1D(2) 

C(1184)  = WDS1D(3) 

C( 1 188)  = WDS1D(4) 

»»«»»»««»»»»»»»»»»»««»»»»»«»» 

IF  (T.GT.O.  .OR.  DOC.GE.6.)  RETURN 
WRITE(6,150)  T 
DO  100  1=2,  N 
J = IPL(I-1 ) 

100  WRITE(6,200)  J,  C(J),  C(J+3) 

CALL  DUMPO 
150  F0RMAT(F10.4) 

200  FORMATd  10,  1P2E15.7) 

RETURN 
END 
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SUBROUTINE  C4I 
COMMON  C(3830) 

DIMENSION  IPL(IOO),  ISNDX(40) 

EQUIVALENCE  (C(363M),  ISNDX(I)),  (C(3512),  13512) 
DIMENSION  BDLT(4) 

DIMENSION  G1(4),G2(M),G3(4),W1(4),ZN(4),WN(4) 
DIMENSION  H1(4),  H2(4),  BH(4) 

EQUIVALENCE  ( C( 1 1 20 ) , G 1 ( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 24  ) , ZN  ( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 28 ) , WN ( 1 ) ) 

EQUIVALENCE  ( C( 1 1 32 ) , W 1 ( 1 ) ) 

EQUIVALENCE  ( C ( 1 1 3b ) , G2( 1 ) ) 

EQUIVALENCE  ( C( 1 1 1 6 ) , G3 ( D ) 

EQUIVALENCE  ( C( 1 1 48 ) , H 1 ( 1 ) ) 

EQUIVALENCE  ( C( 11 52 ) , H2( 1 ) ) 

EQUIVALENCE  ( C( 1 1 56 ) , BH ( 1 ) ) 

EQUIVALENCE  ( C( 1 1 03 ) , BDELT 1 ) 

EQUIVALENCE  ( C(1 1 07 ) , BDELT2) 

EQUIVALENCE  ( C( 1 1 1 1 ) , BDELT3 ) 

EQUIVALENCE  ( C( 1 1 1 5 ) , BDELT4 ) 

EQUIVALENCE  ( C( 1 247 ) , FELECB  ) 

EQUIVALENCE  { C ( 1 248 ) , FELECQ ) 

EQUIVALENCE  ( C(1 24 9 ) , FELECK ) 

EQUIVALENCE  ( C ( 1 250 ) , FMECHB  ) 

EQUIVALENCE  ( C( 1 25 1 ) , FMECHQ) 

EQUIVALENCE  ( C ( 1 252 ) , FMECHR ) 

EQUIVALENCE  ( C( 1 1 40 ) , OPTACT ) 

EQUIVALENCE  (C(1141),BDP  ) 

EQUIVALENCE  (C(1142),BDQ  ) 

EQUIVALENCE  (C(1143),BDR  ) 

EQUIVALENCE  ( C( 1 1 96 ) , BDLT( 1 ) ) 

EQUIVALENCE  (C(2561),N  ) 

EQUIVALENCE  ( C( 2562 ) , I PL ( 1 ) ) 

C(377)=0.0 
C(378)=0.0 
C( 1 192)=0. 0 
C( 1 193)=0.0 
C( 1 194)=0.0 
C( 1 195)=0.0 
IPL(N)  = 1100 
IPL(N+1)  = 1104 
IPL(N+2)  = 1108 
IPL(N+3)  = 1112 
N = N+4 

IPL(N  ) = 1160 
IPL(N+1)  = 1164 
IPL(N+2)  = 1168 
IPL(N+3)  = 1172 
IPL(N+4)  = 1176 
IPL(N+5)  = 1180 
IPL(N+6)  = 1184 
IPL(N+7)  = 1188 
N = N+8 
IPL(N)=1084 
IPL(N+1 )=1088 
IPL(N+2)=1092 
IPL(N+3)=1096 
N=N  + 4 

C( 1087)=0.0 
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C( 1091 )= 

0.0 

C( 1095)= 

0.0 

C( 1099)= 

0.0 

C( 1 163)  = 

0. 

C(1167)  = 

0. 

C(  1 171  ) = 

0. 

C(  1 175)  = 

0. 

C(1179)  = 

0. 

C(1183)  = 

0. 

C( 1 187)  = 

0. 

'Ct  1 1 9‘1  ) = 

0. 

RETURN 

ENTRY  All 

MONTE  CARLO  FIN  MISALIGNMENT  ERRORS 


FELECB 
FELECQ 
FELECR 
FMECHB 
FMECHQ 
FMECHR 
DO  10 


= 0. 
= 0. 

= 0. 

= 0. 
= 0. 

= 0. 

I = 1. 


13512 


IDO  = I 

IFClSNDXd)  ,EQ.  1250)  CALL 
IFdSNDXd)  ,EQ.  1251)  CALL 
IFdSNDXd)  .EQ.  1252)  CALL 
C MONTE  CARLO  FIN  OFFSET  (MODULE 
IFClSNDXd  ) .EQ.  1247)  CALL 
IFClSNDXd)  .EQ.  1248)  CALL 
IFClSNDXd)  .EQ.  1249)  CALL 


MCARLO  (DUM, 
MCARLO  (DUM, 
MCARLO  (DUM, 
C4I  AND  C4) 
MCARLO  (DUM, 
MCARLO  (DUM, 
MCARLO  (DUM, 


I-  FMECHB 
FMECHQ 
FMECHQ 


0.)  GO  TO  20 


DELTB  = FELECB 

DELTQB  = FELECQ 

DELTRB  = FELECR 

10  CONTINUE 

IF  (OPTAd  .LE. 

OPTACT  = 0. 

DO  5 1=1,4 

READ(5,200)G1(I) ,ZN(I) ,WN( 
» H1d),H2(I),BH(I),I8 
) WRITE(6, 300)18, I, GUI), ZN( 
* HKD  ,H2d)  ,BH(I) 

200  FORMAT(9F8. 3, IB) 

300  F0RMAT(I6, I2,9F8.3) 

20  CONTINUE 

BDELT1  = -BDP  + BDQ  - BDR 

BDELT2  = -BDP  + BDQ  + BDR 


I)  ,W1(I) ,G3(I) 
I)  ,WN(I) ,W1(I) 


BDELT3  = 
BDELT4  r 
BDLT( 1 ) 
BDLT(2) 
BDLT(3) 
BDLT(4) 
RETURN 
END 


BDP  + BDQ 

BDP  + BDQ 

BDELT1 

BDELT2 

BDELT3 

BDELT4 


BDR 

BDR 


, IDO) 
, IDO) 
, IDO) 

, IDO) 
, IDO) 
, IDO) 


,G2(I) , 

,G3d)  ,G2(I)  , 
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SUBROUTINE  DTA(XIN,J) 

COMMON  C(3830) 

DIMENSION  REF(4  ) ,BIT(i| ) 
EQUIVALENCE  ( C ( 3^5 3 ) , REF ( 1 ) ) 
EQUIVALENCE  ( C ( 3^57 ), BIT ( 1 ) ) 

C REFd  THRU  4)  IS  BDELTCd  THRU  4) 

SIG  =1. 

IF(XIN.LT.O. )SIG  =-1. 

XIN=ABS(XIN) 

IF{XIN.LT.REF(  'T)  )G0‘  TO  ’ VO*  ’ “ ' 
WRITE(6,  1‘<)C(2000)  ,XIN,  J 
14  FORMAT(6H  DTOA  ,2E20. 10,15) 

XIN  rREF(J) 

GO  TO  100 

10  XIN=XIN-AMOD(XIN,BIT(J)) 

100  XIN=SIG  »XIN 
RETURN 
END 


'fS*'  ■ 
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SUBROUTINE  D1 

•TRANSLATIONAL  DYNAMICS  MODULE 
COMMON  C(3830) 


••INPUT  DATA 

EQUIVALENCE  ( C ( 1 627 ), AGRA V ) 
EQUIVALENCE  ( C( 1 628 ) , DMASS  ) 
EQUIVALENCE  ( C( 1 629 ) , ATHRST ) 
EQUIVALENCE  ( C ( 1 630 ) , ATURNT ) 
EQUIVALENCE  ( C ( 1 63 1 ) , BGAMT  ) 
EQUIVALENCE  ( C( 1 639 ) , OPTARG ) 
EQUIVALENCE  ( C( 1 68 1 ) , ADI VE  ) 
EQUIVALENCE  ( C ( 1 75 1 ) , CRAD  ) 


••INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  ( C C 1 300 ) , FXBA  ) 
EQUIVALENCE  (C(13C1),FYBA  ) 
EQUIVALENCE  ( C( 1 302 ) , FZBA  ) 
EQUIVALENCE  ( C ( 1 703 ) , CFA 1 1 ) 
EQUIVALENCE  ( C(1 707 ) , CFA 1 2 ) 
EQUIVALENCE  ( C(1 7 1 1 ) , CFA 1 3 ) 
EQUIVALENCE  ( C ( 1 7 1 5 ) , CFA2 1 ) 
EQUIVALENCE  ( C(1 7 1 9 ) , CFA22  ) 
EQUIVALENCE  ( C ( 1 723 ) , CF A23  ) 
EQUIVALENCE  ( C( 1 727 ) , CFA3 1 ) 
EQUIVALENCE  ( C ( 1 7 3 1 ) , CFA32  ) 
EQUIVALENCE  ( C(1 735 ) , CFA33  ) 
EQUIVALENCE  (C(2000),T  ) 

••STATE  VARIABLE  OUTPUTS 

EQUIVALENCE  ( C( 1 600 ) , VXED  ) 
EQUIVALENCE  (C(1603),VXE  ) 
EQUIVALENCE  ( C( 1 604 ) , VYED  ) 
EQUIVALENCE  (C(1607),VYE  ) 
EQUIVALENCE  ( C ( 1 608 ) , VZ ED  ) 
EQUIVALENCE  (C(l6n),VZE  ) 
EQUIVALENCE  ( C( 1 6 1 2 ) , RXED  ) 
EQUIVALENCE  (C(1615),RXE  ) 
EQUIVALENCE  ( C( 1 6 1 6 ) , RYED  ) 
EQUIVALENCE  (C(1619),BYE  ) 
EQUIVALENCE  ( C( 1 620 ) , RZED  ) 
EQUIVALENCE  (C(1623),RZE  ) 
EQUIVALENCE  (C( 1 640) , VTARGD) 
EQUIVALENCE  ( C ( 1 64 3 ) , VTARG  ) 
EQUIVALENCE  ( C( 1 644 ) , BPSITD ) 
EQUIVALENCE  ( C ( 1 64 7 ) , BPSIT  ) 
EQUIVALENCE  ,(C(  1648)  .RTXED  ) 
EQUIVALENCE  (C(1651),RTXE  ) 
EQUIVALENCE  ( C ( 1 652 ) , RTYED  ) 
EQUIVALENCE  ( C( 1 655 ) , RTYE  ) 
EQUIVALENCE  ( C( 1 656 ) , RTZED  ) 
EQUIVALENCE  ( C( 1 659 ) , RTZE  ) 


••OTHER  OUTPUTS 

EQUIVALENCE  ( C ( 1 624 ) , AXB A ) 
EQUIVALENCE  ( C( 1 625 ) , AYBA  ) 
EQUIVALENCE  (C(1626),AZBA  ) 
EQUIVALENCE  ( C( 1 632) , VDELX  ) 
EQUIVALENCE  (C( 1 633) , VDELY  ) 


o o no  no 


C 


EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

■EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 


(C(  163A) ,VDELZ  ) 
(C(1635) ,RDELX  ) 
(C( 1636) ,RDELY  ) 
(C( 1637) ,RDELZ  ) 
(C(1638) , VCLSNG) 
(C(1660) ,VTXE  ) 
(C(1661) ,VTYE  ) 
(C(1662),VTZE  ) 

(C( 1663) , VDXB  ) 
(C(166U) ,VDYB  ) 
(C(1665) , VDZB  ) 
(C( 1676) ,ANGX  ) 
(C(1677) ,ANGY  ) 
(C(1678) ,ANGZ  ) 
(C(  371), RANGE  ) 


C**ADD  AERO  AND  THRUST  FORCES  TO  GET  TOTAL  ACCELERATION  IN  BODY  AXES 
AXBA  = FXBA/DMASS 
AYBA  = FYBA/DMASS 
AZBA  = FZBA/DMASS 


»*RESOLVE  FROM  BODY  TO  EARTH  AXES 

AXE  r CFA1  l*AXBA+CFA21*AYBA-t-CFA31*AZBA 
AYE  = CFA12*AXBA+CFA22»AYBA+CFA32*AZBA 
AZE  = CFA13*AXBA+CFA23*AYBA+CFA33*AZBA 


•“INTEGRATE  ACCELERATIONS 
VXED  = AXE 
VYED  = AYE 
VZED  = AZE  + AGRAV 


»*  CALCULATE  TOTAL  MISSILE  ACCELERATION  IN  BODY  AXES 
VDXB  = CFAn*VXED  + CFA12»VYED  + CFA13*VZED 

VDYB  = CFA21“VXED  + CFA22*VYED  + CFA23»VZED 

VDZB  = CFA31*VXED  + CFA32»VYED  + CFA33»VZED 

ANGX  = VDXB/32. 17A 
ANGY  = VDYB/32. 174 
ANGZ  = VDZB/32. 174 
C 


C»*INTEGRATE 
10  RXED  = 
RYED  = 
RZED  = 


VELOCITIES  TO  EARTH  AXES 

VXE 

VYE 

VZE 


POSITTON 


C 

C*»TARGET  MOTION 

IF  (OPTARG  .LE.  0.)  RETURN 
VTARGD  = ATHRST*AGRAV 
BPSITD=  0. 

IF  ( VTARG.GT.O. ) BPSITD=  ATURNT»AGRAV*CRAD/VTARG 
C 

VTXE  = VTARG*C03D(BGAMT)*C0SD(BPSIT) 

VTYE  = VTARG*C03D(BGAMT)*SIND(BPSIT) 

VTZE  = VTARG»SIND(BGAMT) 

C 


RTXED  = VTXE 
RTYED  = VTYE 
RTZED  = VTZE 


VDELX  = VTXE-VXE 
VDELY  = VTYE-VYE 


c 


VDELZ  = VTZE-VZE 


VCLSNG  = (RDELX»VDELX+RDELY»VDELY+RDELZ»VDELZ)/RANGE 

RETURN 

END 
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SUBROUTINE  Dll 

C»»  TRANSLATIONAL  DYNAMICS  INITIALIZATION  MODULE  FOR  D1 
COMMON  C(3B30) 

EQUIVALENCE  (C(256l ) ,N  ) 

EQUIVALENCE  ( C( 2562 ) , I PL ( 1)  ) 

DIMENSION  IPL(IOO),  ISNDX(40),  ITNDX(IO) 

EQUIVALENCE  (C(3634),  ISNDX(I)),  (C(3512),  13512) 


» « 


INPUT  DATA 

EQUIVALENCE  '(tC 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 
EQUIVALENCE  (C( 


toot;  VWXE*  )• 
lOD.VWYE  ) 
102),VWZE  ) 
204),VMACH  ) 

367)  .BALPHA) 

368)  ,BALPHY) 
427),BTHTG  ) 
431),BPSIG  ) 

1639) ,OPTARG) 

1666)  ,BLOSV  ) 

1667) , RSLANT) 
1674),VMWTE  ) 
1751), CRAD  ) 
3502),0PTN2  ) 
3504),OPTN4  ) 
3506),0PTN6  ) 


»»  OUTPUT  TO  MODULES 

EQUIVALENCE  (C(1615) 
EQUIVALENCE  (C(1619) 
EQUIVALENCE  (C(l623) 
EQUIVALENCE  (C(1603) 
EQUIVALENCE  (C(1607) 
EQUIVALENCE  (C(l6n) 
EQUIVALENCE  (C(1651) 
EQUIVALENCE  (C(1655) 
EQUIVALENCE  (C(1659) 
EQUIVALENCE  (C(1668) 
EQUIVALENCE  (C(l669) 
EQUIVALENCE  (C(1670) 
tQUiVALENCE  (C(1671) 
EQUIVALENCE  (C(1672) 
EQUIVALENCE  (C(1673) 
EQUIVALENCE  (C(1752) 
EQUIVALENCE  (C(1753) 
EQUIVALENCE  (C(1754) 
EQUIVALENCE  (C(1665) 
EQUIVALENCE  (C(1635) 
EQUIVALENCE  (C(1636) 
EQUIVALENCE  (C(1637) 
EQUIVALENCE  (C(1680) 
EQUIVALENCE  (C(1681) 
EQUIVALENCE  (C(3753) 
EQUIVALENCE  (C(176l) 
EQUIVALENCE  (C(1762) 
EQUIVALENCE  (C(1763) 
EQUIVALENCE  (C(1755) 
EQUIVALENCE  (C{1756) 
EQUIVALENCE  (C(1757) 
EQUIVALENCE  (C(1758) 


RXE  ) 

RYE  ) 

RZE  ) 

VXE  ) 

VYE  ) 

VZE  ) 

RTXE  ) 

RTYE  ) 

RTZE  ) 

RXO  ) 

RYO  ) 

RZO  ) 

VXO  ) 

VYO  ) 

VZO  ) 

BPHIO  ) 

BTHTO  ) 

BPSIO  ) 

RHZRO  ) 

RDELX) 

RDELY) 

RDELZ) 

RSJYMC) 

RSJZMC) 

ITNDXCI )) ,(C(3721) ,ITCT) 
A01  1 ) 

A012) 

A013) 

A021  ) 

A022) 

A023) 

A031  ) 


83 


o o o n non 


EQUIVALENCE  (C(1759),  A032) 

EQUIVALENCE  (C(1760),  A033) 

EQUIVALENCE  (C(176i4),  PI) 
EQUIVALENCE  (C(1765),  QD 
EQUIVALENCE  (C(1766),  P2) 

EQUIVALENCE  (C{1767),  R2) 

EQUIVALENCE  (C(1768),  XB01) 

EQUIVALENCE  (C(1759),  YB01) 

EQUIVALENCE  (C(1770),  ZBOl) 
EQUIVALENCE  (C(1771),  XB02) 

EQUIVALENCE  (C(1772),  YB02) 

EQUIVALENCE  (C(1773),  ZB02) 

EQUIVALENCE  (C(  360),BPH1ER) 
EQUIVALENCE  (C(  361),BTH2ER) 
EQUIVALENCE  (C(  362),BPS1ER) 
EQUIVALENCE  ( C ( 1 562 ) , GSPOTY ) 
EQUIVALENCE  ( C ( 1 572 ) , GSPOTZ ) 

EQUIVALENCE  ( C( 1 58 1 ) , SIGPC I ) 
EQUIVALENCE  (C(1579),  ZFTrt) 

EQUIVALENCE  (C(1580),  WO) 


* ZERO  OUT  SPOT  JITTER  MAX/MIN  STORAGE  LOCATIONS  THAT  ARE  SAVED  IN  OUTP 
C(1567)  = 0. 

C(1568)  = 0. 

C(1577)  = 0. 

C(1578)  = 0. 

PRINTED  FROM  MODULE  G4 
WO  = 3.9'^ 

ZETA  = .745 

SPOT  JITTER  MONTE  CARLO  INITIAL  VALUES 

RSJYMC  = 0. 

RSJZMC  = 0. 

DO  500  I0L=1 , ITCT 
ITSNDX  = lOL 

IFCITNDXdOL)  .NE.  1680)  GO  TO  502 

IPL(N)=1560 

IPL(N+1 )=1563 

N=N+2 

IF(SIGPOT.NE.O. ) GSPOTY 

1 = .707*SIGP0T/SQRT(W0/4./ZETA  » C(2664)) 

CALL  MCARLO(RNSTRT, 4, ITSNDX) 

502  IFCITNDXdOL)  .NE.  1681  ) GO  TO  500 
IPLCN )=1570 
IPL(N+1 )=1573 
N=N+2 

IFCSIGPOT.NE.O. ) 

1 GSPOTZ  = .7O7»SIGPOT/SQRT(W0/4./ZETA  » C(2664)) 

CALL  MCARLOCRNSTRT, 4, ITSNDX) 

500  CONTINUE 
C 

IPLCN)  = 1600 
IPLCN+1)  = 1604 
IPLCN+2)  = 1608 
IPLCN+3)  = 1612 
IPLCN +4)  z 1616 
IPLCN +5)  = 1620 
IPLCN+6)  = 1640 
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IPL(N+7)  = 1644 
IPL(N+8)  = 1648 
IPL(N+9)  = 1652 
IPL(N+10)  = 1656 
N = N+1 1 
C(  363)  = 0. 

C(  364)  = 0. 

CHAD  = 57.295778 
C 

• ■IF-  (-021.^2.  LE  .0. ) .GO  TO  1002 
IF  (OPTARG  .LE.  0.)  N = N-5 
C 

C*»CALCULATE  MISSILE  PARAMETER  INITIAL  CONDITIONS 
RYE=0. 

RTZE  = 0. 

RTYE  = 0. 

RTXE  = 0. 

BPHIO  = 0. 

XB01  = 0. 

YB01  = 1. 

ZB01  = 0. 

XB02  = 0. 

YB02  = 0. 

ZB02  = 1 , 

C 

C*»*  monte  carlo  AUTOPIF.OT  GYRO  DRIFT  RATES 
PI  = 0. 

Q1  = 0. 

P2  = 0. 

R2  = 0. 

DO  503  I = 1 , 13512 


IFdSNDXd)  .EQ.  1764  ) 

CALL 

MCARLO 

(DUM, 

1, 

IDO) 

IFdSNDXd  ) .EQ.  1765) 

CALL 

MCARLO 

(DUM, 

1, 

IDO) 

IFdSNDXd  ) .EQ.  1766) 

CALL 

MCARLO 

(DUM, 

1, 

IDO) 

IFdSNDXd)  .EQ.  1767) 

CALL 

MCARLO 

(DUM, 

1, 

IDO) 

503  CONTINUE 

»»♦  AUTOPILOT  GYRO  BIAS  ERRORS 


002  BPH1ER  = 0. 

BTH2ER  = 0. 

BPS1ER  = 0. 

DO  11  I = 1,  13512 
IDO  = I 

IFdSNDXd)  .EQ.  360)  CALL  MCARLO  (DUM,  1,  IDO) 

IFdSNDXd  ) .EQ.  361  ) CALL  MCARLO  (DUM,  1,  IDO) 

IFdSNDXd ) .EQ.  362)  CALL  MCARLO  (DUM,  1,  IDO) 

11  CONTINUE 


»»  INITIALIZE  MATRIX  COEF  FOR  AUTOPILOT  GYRO  MODELS 


US PH  II 
UCPHI1 
USTHT2 
UCTHT2 
U3P3I1 
UCPSI1 
A01  1 = 


= SIND(BPHIO  + BPH1ER) 
= COSD(BPHIO  + BPHIER) 
= SIND(BTHTO  + BTH2ER) 
= COSD(BTHTO  + BTH2ER) 
= SIND(BPSIO  + BPS1ER) 
= COSD(BPSIO  + BPS1ER) 
UCPSI1*UCTHT2 
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A012  r USPSI 1»UCTHT2 
A013  = -USTHT2 

A021  = -USPSI1*UCPHI1  + UCPSI1*USTHT2»USPHI1 
A022  = UCPSI  1*UCPHI  1 + USPSIl •USTHT2*USPH1 1 
A023  = UCTHT2*USPH1 1 

A031  = UCPSI1»USTHT2»UCPHn  + USPS1 1 »USPH1 1 
A032  = USPSI1*USTHT2*UCPHI1  - UCPSn»USPHI1 
A033  = UCTHT2»UCPHI  1 
IF  (0PTN2  .LE.  0)  RETURN 


MISSILE  INITIAL  ATTITUDE  ERROR'S' 


C 


C 


C 


c 


c 


DO  5 I = 1 , 13512 
IDO  = I 

IFdSNDXCI)  .EQ.  1752) 
IFdSNDXd)  .EO.  1753) 
IFClSNDXd  ) .EO.  1754) 
5 CONTINUE 


CALL  MCARLO  (DUM,  1, 
CALL  MCARLO  (DUM,  1, 
CALL  MCARLO  (DUM,  1, 


IDO) 

IDO) 

IDO) 


IF  (OPTN2.GT. 1.0)  GO  TO  10 

RXE=-RSLANT*COSD(BLOSV) 

RZE=RSLANT*SIND(BLOSV) 

GO  TO  20 

10  RSLANT  = SgRT(RZE«*2  + RXE*»2) 
20  RH  = RHZRO  - RZE 


IF  (OPTN4  .GT.  0. ) GO  TO  30 

BPSIO  = CRAD»ARSIN(SIND(BPSIG)»RSLANT/RXE) 

CPSIO  = COSD(BPSIO) 

TTHTG  = SIND(BTHTG)/COSD(BTHTG) 

BTHTO  = ATAND( (-RZE/RXE  - TTHTG«CPSIO) ,( CPSIO  - TTHTG»RZE/ RXE  ) ) 
GO  TO  40 
30  CONTINUE 

IF  (OPTN4  .GT.  1 .)  GO  TO  40 
UST  = SIND(BTHTO) 

USP  = SIND(BPSIO) 

UCP  = COSD(BPSIO) 

UCT  = COSD(BTHTU) 

UCPH  = COSD(BPHIO) 

USPH  = SIND(BPHIO) 

RXBA  = -RXE»UCP*UCT  + RZE»UST 

RYBA  = -RXE*(UCP*UST«USPH  - USP*UCPH)  - RZE«UCT«USPH 

RZBA  = -RXE»(UCP»UST*UCPH  + USP«USPH)  - RZE«UCT»UCPH 

BTHTG  = ATAND(-RZBA, RXBA) 

BPSIG  = ATAND(  R YBA ,( RXBA»COSD ( BTHTG )-RZBA»SIND( BTHTG )) ) 

40  CONTINUE 


VSOUND 

= 1117.3  - 

IF  (OPTN6  .LE.  0.) 

VMWXY 

= VMWTE*C03D 

VXE  = 

VMWXY  » COSD 

VYE  = 

VMWXY  » SIND 

VZE  = 

VMWTE  » SIND 

RXO  = 

RXE 

RYO  = 

RYE 

RZO  = 

RZE 

VXO  = 

VXE 

VYO  = 

VYE 

. 00392»RH 

VMWTE  = VMACH*VSOUND 
(BALPHA  - BTHTO) 

(BALPHY  + BPSIO) 
(BALPHY  + BPSIO) 
(BALPHA  - BTHTO) 


86 


on  nooo  oooo  oo 


C»» 


SUBROUTINE  D2 

ROTATIONAL  DYNAMICS  MODULE 
common  C(3a30) 


»*DATA  INPUTS 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 


(C(1748),FMIX  ) 

(C( 1749) ,FMIY  ) 
(C( 1750) ,FMIZ  ) 
(C( 1751 ) ,CRAD  ) 
(C(3503) ,0PTN3) 


•♦INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  ( C ( 1 303 ) , FMXBA  ) 
EQUIVALENCE  ( C ( 1 304 ) , FMYBA  ) 
EQUIVALENCE  ( C ( 1 305 ) , FMZBA  ) 


••STATE  VARIABLE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 

equivalence 

EQUIVALENCE 


OUT 

PUTS 

(C( 

1700) 

,CFA1 ID) 

(C( 

1703) 

,CFA1  1 

) 

(C( 

1704) 

,CFA12D) 

(C( 

1707) 

,CFA12 

) 

(C( 

1708) 

,CFA13D) 

(C( 

1711) 

,CFA13 

) 

(C( 

1712) 

,CFA21D) 

(C( 

1715) 

,CFA21 

) 

(C( 

1716) 

,CFA22D) 

(C( 

1719) 

, CFA22 

) 

(C( 

1720) 

,CFA23D) 

(C( 

1723) 

,CFA23 

) 

(C( 

1724) 

,CFA31D) 

(C( 

1727) 

,CFA31 

) 

(C( 

1723) 

,CFA32D) 

(C( 

1731  ) 

,CFA32 

) 

(C( 

1732) 

,CFA33D) 

(C( 

1735) 

,CFA33 

) 

(C( 

1736) 

, WPD 

) 

{C( 

1739) 

,WP 

) 

(C( 

1740) 

,WQD 

) 

(C( 

1 743) 

,WQ 

) 

(C( 

1744) 

,WRD 

) 

(C( 

1 747) 

,WR 

) 

*****  yaw  PARAMETER  INPUT 

EQUIVALENCE(C(2901 ) .OPTNYW) 


••INTEGRATE  BODY  ANGULAR  RATES 
IF  (OPTN3. LE.O. ) GO  TO  45 
IF  (OPTNYW.LE.O. ) GO  TO  55 
GO  TO  65 

45  WPD  = CRAD*FMXBA/FMIX 

55  WRD  = (CRAD*FMZBA+(FMIX-FMIY)^WP»WQ/CP.AD)/FMIZ 
65  WQD  = (CRAD^FMYBA+(FMIZ-FMIX)»WP»WR/CRAD)/FMIY 


••INTEGRATE  ATTITUDE  DIRECTION  COSINES 
49  CFA1 1D=(CFA21»WR-CFA31*WQ)/CRAD 
CFA12D= (CFA22^W R-CF A 32* WQ)/CR AD 
CFA13D=(CFA23*WR-CFA33*WQ)/CRAD 
CFA21D  = (CFA31 *WP-CFA1 1»WR)/CRAD 
CFA22D  = (CFA32»WP-CFA12»WR)/CRAD 
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CFA23D  = (CFA33»WP-CFA13»WR)/CRAD 
CFA31D  = (CFAn»WQ-CFA21»WP)/CRAD 
CFA32D  = (CFA12»WQ-CFA22»WP)/CRAD 
CFA33D  = (CFA13*WQ-CFA23*WP)/CRAD 
RETURN 
END 


SUBROUTINE  D2I 

C»»ROTATIONAL  DYNAMICS  INITIALIZATION  MODULE  D2IEUL 
COMMON  C(3830) 

DIMENSION  IPL  (100) 

C«»INPUT  DATA 

EQUIVALENCE  ( C( 1 752 ) , BPHIO  ) 

EQUIVALENCE  ( C( 1 753 ) , BTHTO  ) 

EQUIVALENCE  ( C( 1 754 ) , BPSIO  ) 

C»»INPUTS  FROM  MAIN  PROGRAM 

EQUIVALENCE  (C(2561),N  ) 

EQUIVALENCE  (C(2562),IPL  ) 

C»»STATE  VARIABLE  OUTPUTS 

EQUIVALENCE  ( C( 1 703 ) , CFA 1 1 ) 

EQUIVALENCE  ( C ( 1 707 ) , CFA 1 2 ) 

EQUIVALENCE  ( C(1 7 1 1 ) , CFA 1 3 ) 

EQUIVALENCE  ( C( 1 7 1 5 ) , CFA2 1 ) 

EQUIVALENCE  ( C ( 1 7 1 9 ) , CFA22  ) 

EQUIVALENCE  ( C( 1 723 ) , CFA23  ) 

EQUIVALENCE  ( C( 1 727 ) , CFA3 1 ) 

EQUIVALENCE  ( C( 1 73 1 ) , CFA32  ) 

EQUIVALENCE  ( C( 1 735 ) , CFA33  ) 

C*»OTHER  OUTPUTS 

EQUIVALENCE  ( C( 1 755 ) , A02 1 ) 

EQUIVALENCE  (C(1756),A022  ) 

EQUIVALENCE  ( C( 1 757 ) , A023  ) 

EQUIVALENCE  ( C( 1 75B ) , A03 1 ) 

EQUIVALENCE  ( C( 1 759  ) , A032  ) 

EQUIVALENCE  ( C( 1 7bO ) , A033  ) 

C»»INITIAL  CALCULATION  OF  EULER  ANGLE  MATRIX  OF  DIRECTION  COSINES  (CFA 
USPHI  = SIND(BPHIO) 

UCPHI  = COSD(BPHIO) 

USTHT  = SIND(BTHTO) 

UCTHT  = COSD(BTHTO) 

USPSI  = SIND(BPSIO) 

UCPSI  = COSD(BPSIO) 

CFAll  = UCPSI»UCTHT 
CFA12  = USPSI^UCTHT 
CFA13  = -USTHT 

CFA21  = -USPSI»UCPHI+UCPSI*USTHT»USPHI 
CFA22  = UCPSI*UCPHI+USPSI»USTHT»USPHi 
CFA23  = UCTHT»USPHI 

CFA31  = UCPSI*USTHT*UCPHI+USPSI«USPHI 
CFA32  = USPSI»USTHT«UCPHI-UCPSI«USPHI 
CFA33  = UCTHT»UCPHI 
C 

C»»INITIALIZE  MATRIX  COEF  FOR  FREE  GYRO  MODEL(S) 

C 

C»»INTEGRATED  PARAMATER  LIST  (IPL)  FOR  WPD , WQD , WRD , AND  CFAD 
IPL(N)  = 1700 
IPL(N+1)  = 1704 
IPL(N+2)  = 1708 
IPL(N+3)  = 1712 
IPL(N+4)  r 1716 
IPL(N+5)  = 1720 
IPL(N+6)  = 1724 
IPL(N+7)  = 1728 
IPL(N+8)  = 1732 
IPL(N+9)  = 1736 
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r 1 

IPL(N-*-11)  = 1744  * 

N = N+12 

I RETURN  ] 

i END 


\ 

1 
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FUNCTION  FINTP1(X,XI,YI,N,r ,XL) 
DIMENSION  XI(N),  YI(N) 

IF(F  .GT.  0. )GO  TO  30 
DO  10  1=2,  N 

IF(X  .LE.  XKD)  GO  TO  20 
10  CONTINUE 
I = N 

20  PCT  = (X-XI(I-1 ))/(XI(I)-XI(I-1)) 

F = 1 . 

30  FINTP1  = YI(I-I)  + PCT»(YI(I)-YI(I-1)) 
RETURN 
END 
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FUNCTION  FINTP2(X, Y,XI , YI,ZI, HX,NY,NXY,F,XL) 
DIMENSION  XKNX)  ,YI(NY)  , ZI(NXY),  T(2),  COL(IO) 
IF(F  .GT.  0. ) GO  TO  30 
DO  10  1=2,  NY 
IF(Y  .LE.  YKD)  GO  TO  20 
10  CONTINUE 
I = NY 

20  PCT  = (Y-YI(I-1))/(YI(I)-YI(I-1)) 

30  DO  40  J=1 ,2 
L = I + J - 2 
L1NX  = (L-1)*NX 
LlNXl  = LINX  + 1 
LNX  = L » NX 
DO  50  IR  = L1NX1 , LNX 
50  CUL(IR-LINX)  = ZKIR) 

40  T(J)  = FINTP1(X,XI,COL,NX,F,XL) 

FINTP2  = T(1)  + PCT*(T(2)-T(1  ) ) 

RETURN 

END 
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SUBROUTINE  G3 
C»»AIR  DATA  MODULE  G3 
COMMON  C(3830) 

C»»INPUT  DATA 

EQUIVALENCE  ( C( 0203 ) , RHZRO  ) 

C««INPUTS  FROM  OTHER  MODULES 

EQUIVALENCE  ( C( 0 1 00 ) , VWXE  ) 

EQUIVALENCE  ( C( 0 1 0 1 ) , VWYE  ) 

EQUIVALENCE  ( C( 0 1 02 ) , VWZE  ) 

EQUIVALENCE  (C(1603),VXE  ) 

EQUIVALENCE  (C(1607),VYE  ) 

EQUIVALENCE  (C(1611),VZE  ) 

EQUIVALENCE  (C(1623),RZE  ) 

C»»INPUTS  FROM  MAIN  PROGRAM 
C»»STATE  VARIABLE  OUTPUTS 
C»»NON£ 

C*»OTHER  OUTPUTS 

EQUIVALENCE  ( C( 0200 ) , VMWXE  ) 

EQUIVALENCE  ( C(020 1 ) , VMWYE  ) 

EQUIVALENCE  ( C( 0202 ) , VMWZE  ) 

EQUIVALENCE  ( C( 0203 ) , PDYNMC) 

EQUIVALENCE  ( C( 0204 ) , VMACH  ) 

EQUIVALENCE  ( C(0205) , DRHO  ) 

EQUIVALENCE  ( C( 0206 ) , VSOUND) 

EQUIVALENCE  ( C( 0207 ) , VA IRSP ) 

EQUIVALENCE  (C(0209),RH  ) 

C»»CALCULATE  PRESENT  ALTITUDE 
RH=  -RZE+RHZRO 

C»»CALCULATE  MISSILE  VELOCITY  WRT  AIR  MASS  IN  EARTH  AXES 
VMWXE  = VXE-VWXE 
VMWYE  = VYE-VWYE 
VMWZE  = VZE-VWZE 

VAIHSP  = SQRT(VMWXE»VMWXE+VMWYE»VMWYE+VMWZE»VMWZE) 
C*»AIR  DENSITY,  SPEED  OF'SOUND,  DYNAMIC  PRESSURE,  AND  MACH 
DRHO={  .0.'fa475)/(  1 . + . 3325E-04»RH+RH»RH»RH«.0231bE-12) 
VSOUND  = - ,00392»RH-*-1  1 17. 3 
PDYNMC  = (DRH0»VAIRSP»VAIRSP)/64.344 
VMACH  = VAIRSP/VSOUND 
RETURN 
END 


t 
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SUBROUTINE  0^4 

C»»  THIS  IS  A SUBROUTINE  (NOT  A MODULE)  CALLED  BY  STAGE  3 ** 

C««  STOPS  PROGRAM  AND  COMPUTES  MISS  DISTANCE  ** 

COMMON  C(3830) 

COMMON  /XMA/XMAX(4,7) 

100  FORMAT( 1H0, 17H  MISS  DISTANCE  = ,1PE15.7/ 

» 1H0,17H  FLIGHT  TIME  = ,1PE15.7) 

200  FORMATdHO,  9X,8HRDELX  = ,1PE15.7,  8X,8HRDELY  = ,1PE15.7, 

* 8X,8HRDELZ  = ,1PE15.7) 

300  FORMAT(  1HO,ilOX,8HRYFP  = ,1PE15.7,  8X,8HRZFP  = ,1PE15.7) 
EQUIVALENCE  (C(  357),BGAMH  ) 

»,  (C(  358),BGAMV  ) 

*,  (C(  371), RANGE  ) 

»,  (C( 1635) ,RDELX  ) 

*,  (C(  1636)  ,RDELY  ) 

*,  (C(1637) .RDELZ  ) 

EQUIVALENCE  (C(2000),T  ) 

EQUIVALENCE  ( C(  1 56^1 ) , YMC) 

EQUIVALENCE  ( C( 1 565 ) , YMC2 ) 

EQUIVALENCE  (C( 1 57^ ) ,ZMC) 

EQUIVALENCE  ( C ( 1 575 ) , ZMC2 ) 

»,  (C(2020) ,LCONV  ) 

EQUIVALENCE  (C(  300),RMISS  ) 

$,  (C(301),L  ) 

*,  (C(  302), RYF  ) 

»,  (C(  303), RZF  ) 

EQUIVALENCE  (C(  31),  LCEP) 

EQUIVALENCE  (C(3721),  ITCT) 

EQUIVALENCE  (C(3000),VSD  (1)) 

EQUIVALENCE  ( C( 301 0) , VMEAN  (1)) 

EQUIVALENCE  ( C( 3020) , IMVNDX( 1 ) ) 

EQUIVALENCE  ( C( 3030 ) , IM VCT  ) 

EQUIVALENCE  (C( 1651 ) , RTXE ) , ( C( 1 655 ) ,RTYE) , ( C(  1 659 ) , RTZE ) , ( C( 1 6 1 5 ) 
. ,RXE) , (C( 1619) , RYE) ,(C( 1623) ,RZE) 

REAL*8  PITCH,  YAW 

DATA  PITCH, YAW/8HPITCH  , 8HYAW  / 

DIMENSION  IMVNDXdO),  VMEANdO),  VSDdO) 

DIMENSION  VSUMdO),  VS2dO) 

LCEP  = 0 
RDELX=RTXE-RXE 
RDELY=RTYE-RYE 
RDELZ=RTZE-RZ£ 

IF(RDELZ  .LT.  0.  .OR.  RDELX  .LT.  0.)  LC0NV=2 
IF  (RANGE  .GT.  500.)  GO  TO  20 
UC13  =-SIND(BGAMV) 

UC33  = COSD(BGAMV) 

UC21  :-SIND(BGAMH) 

UC22  = COSD(BGAMH) 

UC11  = UC22»UC33 

UC12  = -UC21»UC33 
UC31  = -UC22»UC13 
UC32  = UC21*UC13 

RXFP  = UC11*RDELX  + UC12»RDELY  + UC13*RDELZ 
RYFP  = UC21*RDELX  + UC22»RDELY 
RZFP  = UC31*RDELX  UC32»RDELY  + UC33*RDELZ 
IF  (RXFP  .GT.  0. ) GO  TO  10 
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DO  5 1 = 1 , IMVCT 
IDO  = IMVNDX(I) 

VALUE  = C(IDO) 

VSUM(I)  = VSUH(I)  + VALUE 
VS2(I ) = VS2(I  ) + VALUE*»2 
TCASE  = L 
TCASE1  = L - 1 
VMEAN(I)  = VSUMd  )/TCASE 
IF(L  .NE.  1)  GO  TO  2 

32  = {VS2(I)  - (VSUMd  )*»2)/TCASE)/TCASE 
GO  TO  3 

2 32  = (VS2d)  - (VSUMd  )»»2)/TCASE)/TCASE1 

3 VSDd)  = SgRT(S2) 

5 CONTINUE 

50  CONTINUE 


PCT 

z 

UXFP/(RXFP  - UXFP) 

RDX 

z 

UDELX 

- PCT»(RDELX 

- UDELX) 

RDY 

z 

UDELY 

- PCT»(RDELY 

- UDELY) 

RDZ 

z 

UDELZ 

- PCT»(RDELZ 

- UDELZ) 

RYF 

z 

UYFP  - 

PCT»(RYFP  - 

UYFP) 

RZF 

z 

UZFP  - 

PCT»(RZFP  - 

UZFP) 

TZERO 

= UT  - 

PCT»(T  - UT) 

RMISS 

= SQRT(RYF**2  + RZF 

*«2) 

WRITE(6,600)C(630) .pitch 
WRITE(6,600)C(631 ) ,YAW 

600  FORMAT( 1H0, 60X, 24H+++MAX  BREAKLOCK  VALUE  =F10.5,5H  IN  ,A8) 

WRITE(6 , MOO)  L 

400  FORMATdHO,  13HRUN  NUMBER  = ,12) 

IF(ITCT.LE.0)G0  TO  30 
CALL  MCARLX(DUM ,2, RNSTRT) 

WRITE(6,500)  C(1567),  C(1568),  C(1577),  C(1578) 

XMCSPT  = SQRT(YMC2»TMC2  + ZMC2»ZMC2) 

WRITE(6 ,2555)YMC,  YMC2 
WR ITE( 6, 2556 )ZMC,ZMC2, XMCSPT 
30  CONTINUE 

500  FORMATdHO,  riX,  13HMAX  SPOT  Y = ,F6.2,14H  MIN  SPOT  Y = , F6.2/ 

' 1 12X,13HMAX  SPOT  Z = ,F6.2,14H  MIN  SPOT  Z = ,F6.2// 

2 ) 

2555  FOKMAT( 1H0,  1 1X,26HSAMPLE  SPOT  JITTER  Y-MEAN= , F 1 0. 5, 6X , 12HMEAN  SQUA 
1RE=,F10.5) 

2556  FORMATdHO,  nX,26HSAMPLE  SPOT  JITTER  Z -MEAN=  , F 1 0 . 5 , 6X  , 1 2HMEAN  SQUA 
1RE=,F10.5,6X, IdHSPOT  RADIAL  RMS  = ,F10.5) 

WRITE(6,100)  RMISS,  TZERO 
WRITE(6, 17)XMAX 
17  FORMAT(7E17.8) 

'VRITE(6 , 200)  HDX,  RDY,  RDZ 
WRITE(6,300)  RYF,  RZF 
LCONV  = 2 
LCEP  = , 


RETURN 
10  UT  = T 

UDELX  = RDELX 
UDELY  = RDELY 
UDELZ  = RDELZ 
UXFP  = HXFP 
UYFP  = HYFP 
UZFP  = RZFP 
RETURN 


20  CONTINUE 
RETURN 
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SUBROUTINE  G5 

C»*COORDINATE  CONVERSION  MODULE 
COMMON  C{3B:iO) 


»»INPUTS  FROM  OTHER  MODULES 


EQUIVALENCE  (C(0200) 
EQUIVALENCE  (C(0201) 
EQUIVALENCE  (C(0202) 
EQUIVALENCE  (C(0207) 
EQUIVALENCE  (C(1317) 
EQUIVALENCE  (C(1405) 
EQUIVALENCE  (C(1603) 
EQUIVALENCE  (C(1607) 
EQUIVALENCE  (CClbll) 
EQUIVALENCE  (C(1615) 
EQUIVALENCE  (C(1619) 
EQUIVALENCE  (C(1623) 
EQUIVALENCE  (C(1635) 
EQUIVALENCE  (C(1636) 
EQUIVALENCE  (C(1637) 
EQUIVALENCE  (C(1651) 
EQUIVALENCE  (C(1655) 
EQUIVALENCE  (C(l659) 
EQUIVALENCE  (CClbbB) 
EQUIVALENCE  {C(lbb9) 
EQUIVALENCE  (C(lb70) 
EQUIVALENCE  (C(lb71) 
EQUIVALENCE  (C(lb72) 
EQUIVALENCE  (C(1b73) 
EQUIVALENCE  (C(1b80) 
EQUIVALENCE  (C(1bai) 
EQUIVALENCE  (C(1b82) 
EQUIVALENCE  (C(1683) 
EQUIVALENCE  (C(lb84) 
EQUIVALENCE  (C(3753) 
EQUIVALENCE  (C(3721) 
EQUIVALENCE  (C(1560) 
EQUIVALENCE  (C(15b1) 
EQUIVALENCE  (C(15b2) 
EQUIVALENCE  (C(15b3) 
EQUIVALENCE  (C(15bb) 
EQUIVALENCE  (C(1570) 
EQUIVALENCE  (C(1571) 
EQUIVALENCE  (C(1572) 
EQUIVALENCE  (C(1573) 
EQUIVALENCE  (C(157b) 
EQUIVALENCE  (C(1579) 
EQUIVALENCE  (C(1580) 
DIMENSION  ITNDX(IO) 
EQUIVALENCE  (C(1703) 
EQUIVALENCE  (C(1707) 
EQUIVALENCE  (C(1711) 
EQUIVALENCE  (C(1715) 
EQUIVALENCE  {CC1719) 
EQUIVALENCE  (C(1723) 
EQUIVALENCE  (C(1727) 
EQUIVALENCE  (C(1731) 
EQUIVALENCE  (C(1735) 
EQUIVALENCE  (C(1751) 


VMWXE  ) 
VMWYE  ) 
VMWZE  ) 
VAIRSP) 


RAIL 


,QBURN 
,VXE 
, VYE 
,VZE 
, RXE 
,RYE 
,RZE 
, RDELX 
,RDELY 
, RDELZ 
,RTXE 
, RTYE 
,RTZE 
, RXO 
, RYO 
,RZO 
, VXO 
, VYO 
, VZO 
.RSJYMC) 
,RSJZMC) 
,RSPOTX) 
.RSPOTY) 

, RSPOTZ) 

, ITNDX(I) 
, ITCT) 

, SXPDD) 

, RX) 

.GSPOTY) 

, SXPD) 

, SXP) 

, SYPDD) 

, RY) 

.GSPOTZ) 

, SYPD) 

, SYP) 

, ZETA) 

. WO) 


,CFA1  1 
,CFA12 
,CFA13 
,CFA21 
,CFA22 
,CFA23 
,CFA31 
,CFA32 
,CFA33 
,CRAD 
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1 


! 


k"- 


EQUIVALENCE 

(C( 

1768),  XB01 

) 

EQUIVALENCE 

(C( 

1769),  YBOl 

) 

EQUIVALENCE 

(C( 

1770),  ZB01 

) 

EQUIVALENCE 

{C( 

1771),  XB02 

) 

EQUIVALENCE 

(C( 

177^),  YB02 

) 

EQUIVALENCE 

(C( 

1773),  ZB02 

) 

EQUIVALENCE 

(C( 

1764),  PI 

) 

EQUIVALENCE 

(C( 

1765),  Q1 

) 

EQUIVALENCE 

(C( 

1766),  P2 

!) 

EQUIVALENCE 

(C( 

1767),  R2) 

EQUIVALENCE 

(C( 

1761),  A011 

) 

EQUIVALENCE 

(C( 

1762),  A012 

!) 

EQUIVALENCE 

(C{ 

1763),  A01: 

i) 

EQUIVALENCE 

(C( 

1755) ,A021 

) 

EQUIVALENCE 

(C( 

1756) ,A022 

) 

EQUIVALENCE 

(C( 

1757) ,A023 

) 

EQUIVALENCE 

(C( 

1758) ,A031 

) 

EQUIVALENCE 

(C( 

1759) ,A032 

) 

EQUIVALENCE 

(C( 

1760) ,A033 

) 

EQUIVALENCE 

{C( 

2000)  ,T 

) 

OTHER  OUTPUTS 

EQUIVALENCE 

(C( 

0350) , BTHT 

) 

EQUIVALENCE 

(C(0351 ) ,BPSI 

) 

EQUIVALENCE 

(C( 

0352) , BPHI 

) 

EQUIVALENCE 

(C( 

353) , BPHI 

) 

EQUIVALENCE 

(C( 

354) ,BTH2 

) 

EQUIVALENCE 

(C( 

355) ,BP31 

) 

EQUIVALENCE 

(C{ 

0356) ,VTOTE 

) 

EQUIVALENCE 

(C( 

0357) ,BGAMH 

) 

EQUIVALENCE 

(C( 

0358) ,BGAMV 

) 

EQUIVALENCE 

(C( 

0363) ,BTHLV 

) 

EQUIVALENCE 

(C( 

0364) ,BPSLV 

) 

EQUIVALENCE 

(C( 

0365) ,BLAMV 

) 

EQUIVALENCE 

(C( 

0366) ,BLAMH 

) 

EQUIVALENCE- 

(C( 

0367) ,BALPHA) 

EQUIVALENCE 

(C( 

0368) ,BALPHY) 

EQUIVALENCE 

(C( 

0369) .BALPHP) 

EQUIVALENCE 

(C( 

0370)  ,BPHIP 

) 

EQUIVALENCE 

(C( 

0371 ), RANGE 

) 

EQUIVALENCE 

(C( 

0372)  ,RXBA 

) 

EQUIVALENCE 

(C( 

0373) ,RYBA 

) 

EQUIVALENCE 

(C( 

0374) ,RZBA 

) 

EQUIVALENCE 

(C( 

1663) ,VDXB 

) 

EQUIVALENCE 

(C( 

1664) , VDYB 

) 

EQUIVALENCE 

(C( 

1665) ,VDZB 

) 

EQUIVALENCE 

(C( 

377) ,BALPD 

) 

EQUIVALENCE 

(C( 

378) ,BALYD 

) 

EQUIVALENCE 

(C( 

380) ,RANGO 

) 

EQUIVALENCE 

(C( 

390) ,RXL 

) 

EQUIVALENCE 

(C( 

391 ) ,RYL 

) 

EQUIVALENCE 

(C{ 

392)  ,RZL 

) 

EQUIVALENCE 

(C( 

393) ,BPH2 

) 

c 

C»*CALCULAT10N  OF  HEADING,  PITCH,  ROLL  EULER  ANGLES  IN  DEGREES 
BPHI  = ATAND(CFA23,CFA33) 

BTHT  = ATAND(-CFA13,SQRT(CFA11»CFA1UCFA12«CFA12)) 

BPSI  = ATAND(CFA12,CFA1  1 ) 

C 

C»*FREE  GYRO  MODELS  (INITIAL  GIMBAL  ANGLES  ARE  ZERO) 


1 

j 
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c 

C**  AUTO  PILOT  DRIFT  RATES 
DXB01  = -Q1*TB01/CRAD 
DYBOl  = (Q1*XB01  - PI'ZBOl )/CRAD 
DZB01  = P1»YB01/CRAD 
DXB02  = R2*ZB02/CRAD 
DYB02  = -P2*ZB02/CRAD 
DZB02  = (P2*YB02  - R2«XB02 ) /CKi.D 
C 

XB01  = DXB01*T 
YB01  = 1 . + DYB01*T 
ZB01  = DZB01*T 
XB02  = DXB02»T 
YB02  = DYB02*T 
ZB02  = 1 . + DZB02»T 

Bll  = A011»CFA11  + A012*CFA12  + A013*CFA13 

B12  = A0n*CFA21  + A012*CFA22  + A013*CFA23 

B13  = AOn»CFA31  + A012*CFA32  + A013*CFA33 

B21  = A021»CFA11  + A022»CFA12  + A023»CFA13 

B22  = A021*CFA21  + A022*CFA22  + A023»CFA23 

B23  = A021»CFA31  + A022*CFA32  + A023*CFA33 

B31  = A031*CFAn  + A032»CFA12  + A033*CFA13 

B32  = A031*CFA21  + A032*CFA22  + A033»CFA23 

B33  = A031*CFA31  + A032»CFA32  + A033*CFA33 

XB1  = B11»XB01  + B21»YB01  + B31*ZB01 

YB1  = B12*XB01  + B22»YB01  + B32*ZB01 

ZB1  = B13*XB01  + B23»yB01  + B33*ZB01 

XB2  = B11*XB02  + B21»YB02  + B31*ZB02 

YB2  = B12*XB02  + B22»YB02  + B32»ZB02 
ZB2  = B13*XB02  + B23*yB02  + B33*ZB02 
BPHl  = ATAND  (ZBI.YBI) 

BPSl  = ATAND  (-XB1 ,YB1/COSD(BPHl)) 

BTH2  = ATAND  (XB2,ZB2) 

BPH2  = ATAND  ( -YB2 , ZB2/COSD ( BTH2 ) ) 

C 

C»»CALCULATION  OF  TOTAL  VELOCITY 

VTOTE  = SORT(VXE»VXE+VYE*VYE+VZE*VZE) 

RDELX  = RTXE-RXE 
RDELY  = RTYE-RYE 
RDELZ  = RTZE-HZE 
C 

IF( C( 1 976) .LE.O. ) GO  TO  20 

RXL  = RXE  - RXO  - VXO»T 

RYL  = RYE  - HYO  - VYO«T 

RZL  = RZE  - RZO  - VZO«T 

RANGO  = SQRT(RXL**2  + RYL**2  + RZL*«2) 

VXL  = VXE  - VXO 
VYL  = VYE  - VYO 
VZL  = VZE  - VZO 
20  CONTINUE 

••TRANSFORM  MISSILE  LOS  FROM  EARTH  TO  BODY  AXES 

LINE  OF  SIGHT  OF  LASER  SPOT  WITH  MONTE  CARLO  SPOT  JITTER  INCLUD.  D 

DO  500  I = 1 , ITCT 
IDO  = I 

IFdTNDXd  ) .NE.  1680)  GO  TO  501 
RSJYMC  = GSPOTY*SXP 
CALL  MCARLO  (DUM,2,ID0) 
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SXPDD  = W0»W0»(KX-2.*ZETA*SXPD/W0  - SXP) 
IFClTNDXd  ) .NE.  1681  ) GO  TO  500 
RSJZMC  = GSP0TZ*SYP 
CALL  MCARLO  (DUM,2, IDO) 

SYPDD  = W0*W0»(RY  - 2. *ZETA*SYPD/W0  - SYP) 
CONTINUE 
RSPOTX  = RDELX 
RSPOTY  = RDELY  + RSJYMC 
RSPOTZ  = RDELZ  + RSJZMC 

RXBA  = RSP0TX«CFA11  + RSPOTY«CFA12  + RSP( 

RYBA  = RSPOTX*CFA21  + RSP0TY«CFA22  + RSP( 

RZBA  = RSPOTX*CFA31  + RSP0TY»CFA32  + RSPi 


RSPOTZ«CFA13 

RSP0TZ*CFA23 

RSPOTZ»CFA33 


UVP1  = VXE*RDELX+VYE»RDELY 
UVP2  = RDELX»RDELX+RDELY»RDELY 
UVP3  = VZE*RDELZ 
UVP4  = SQRT(UVP2) 

RANGE  = SgRT(UVP2+RDELZ**2) 

‘•VERTICAL  AND  HORIZONTAL  LINE  OF  SIGHT  ANGLES  (EARTH  AXES) 

BLAMH  = ATAND(-RDELY, RDELX) 

BLAMV  = ATAND(-RDELZ,UVP^) 

“VERTICAL  AND  HORIZONTAL  PROPORTIONAL  NAVIGATION  ANGLES 
IF( VTOTE.LE. 10. ) GO  TO  30 
VXP=(UVP1+UVP3)/RANGE 
VYP  = ( VYE*RDELX-VXE*RDELY)/UVP4 
VZP  = (VZE*UVP2-RDELZ»UVP1)/(RANGE*UVP4) 

BTHLV  = ATAND(VZP, VXP) 

BPSLV  = ATANDCVYP, VXP) 

BGAMV  = ATAND(-VZE,SgRT(VXE*VXE+VYE*VYE)) 

BGAMH  = ATANUCVYE, VXE) 


“VELOCITY  WRT  AIR  IN  BODY  AXES 

VMWU  = CFA1 1»VMWXE+CFA12*VMWYE+CFA13*VMWZE 
VMWV  = CFA21»VMWXE+CFA22»VMWYE+CFA23*VMWZE 
VMWW  = CFA31*VMWXE+CFA32*VMWYE+CFA33*VMWZE 

“VERTICAL  AND  HORIZONTAL  ANGLES  OF  ATTACK 

IF  (gBURN.LE.O.  .AND.  RANGO . LE . RAIL ) GO  TO  30 
BALPHA  = ATAND( VMWW, VMWU) 

BALPHY  = ATANDCVMWV, VMWU) 

USg  = VMWU“2 

BALPD  = (VMWU»VDZB-VMWW»VDXB)/(US0+VMWW“2)«CRAD 
DALYD=(VMWU‘VDYB-VMWV*VDXB)/(US0+VMWV“2)»CRAD 

“ALPHA  PRIME  AND  PHI  PRIME  (WIND  TUNNEL  AXES) 

IF  ( (BALPHA-BALPHY) .Eg.O. ) GO  TO  30 
BPHIP  = ATAND(BALPHY, BALPHA) 

30  BALPHPrSgRT(DALPHA“2+BALPHy“2) 

RETURN 

END 
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SUBROUTINE  LTRAN (T , DELT , AMP , Y , YC , IFLG , K ) 

DIMENSION  A(5,3),  PHI(5,3),  W(5,3) 

DATA  IMAX, AE/4 ,-1 ./ 

DATA  A/1 . ,4. , 12. ,26. ,0. , 1. ,4. , 12. ,26. ,0. , 1. ,4. , 12. ,26. ,0./ 

IF(IFLG.GT.O)GO  TO  17 

ZC=0. 

W1=6.28»1 1 . 

DO  1 I=1,IMAX 

CALL  RANNUM(0. ,RNSTRT,RN) 

PHKI  ,K)  = 3.  14«RN 
W(I ,K)=I*W1 

C ZC  IS  INTEGRATION  CONSTANT  FOR  Z 
B=W(I,K)«T+PHI(I,K) 

ZC=ZC+  A(I,K)»(AE»SIN(B)-W(I,K)»COS(B) )/(AE»»2+W(I,K)»»2) 

1 CONTINUE 
YC=AMP*EXP(AE»T)»ZC 

17  CONTINUE 

Z=0. 

DO  2 1=1 , IMAX 

Z=Z+A(I ,K)*SIN(W(I ,K)»T+PHI(I ,K)) 

2 CONTINUE 
Y=AMP»EXP(AE*T)*Z 
RETURN 

END 
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SUBROUTINE  0INPT1 

C BASIC  INPUT  SUBROUTINE  OINPTl 
COMMON  C(3830) 

COMMON / WKU 1/ONAMEO( 50) 

EQUIVALENCE  ( C( 32 1 8 ) , ONAME U 1 ) ) , ( C( 3268 ) , 0NAME2 ( 1) ) , (C(3318),ONA 
ME3(1  ))  , 

(C(3328) .ONAMEUCI )) , ( C(236 1 ) , NOMOD  >,  ( C( 2362 ) , MODNO 

(1  ))  , 

(C(3168),0UTN0(1)),  (C(2461 ), NOSUB  ),  ( C( 2462 ) , SUBNO 

(1  ))  , 

(C(3066) , NOLIST) ,(C( 3167) ,NOOUT)  , 

(C(3067) ,LISTN0(1 )) , ( C( 3 1 1 7 ) , VALUEC 1 ) ),  (C(2008) , PLOTNO) , 
(C(2009)  , NOPLOT)  , ( C( 2325 ) , VLABLE ( 1 , 1 ) ) , (C(1),K(1)) 
EQUIVALENCE  (CC2010),  STEP) 

EQUIVALENCE  ( C ( 1 984 ) , NPLOT  ) 

EQUIVALENCE  ( C ( 1 985 ) , OUTPLT ( 1 ) ) 

EQUIVALENCE  (C(3512) ,ISGCT) ,(C(3514) ,SIGMA( 1 )) , ( C( 3554 ) , SIGLB 
(1)),(C(3594),SIGUB(1)), 

(C(3634) ,ISNDX( 1 ) ) , (C(3674) ,IDIST(1 )) ,(C(351 1) ,RNSTRT) 
EQUIVALENCE(C(3721) ,ITCT) ,(C(3723) ,TSGMA(1 )) ,(C(3733) ,TLB( 1 )) , 
(C(374  3) ,TUB(1 )) ,(C(3753) ,ITNDX(1 )),( C( 3763) , ITDISTC 1 )),( C( 3773)  , 
TSPERd  ))  , 

(C(3783) ,T7PPER(1 )) ,(C(3793) ,TPSIG(1 ) ) , ( C( 3803 ) , TNXST( 1 ) ) ,(C(3813) 
C ,ITNDX2(1)) 

■ EQUIVALENCE  (C(  21),IBVNSW) 

EQUIVALENCE  (C(  22),  IPLOT) 

: EQUIVALENCE  ( C ( 1 9 ) , PSIZ E ) 

EQUIVALENCE  (C(  23),XLAMBD) 

EQUIVALENCE  (C(  24),  KSSIG) 

EQUIVALENCE  (C(  25 ) , CEPSIG ( 1 ) ) 

W-  EQUIVALENCE  (C(3825),  NCASE) 

EQUIVALENCE  ( C(  3020 ) , IM  VNDX  ( 1 ) ) 

EQUIVALENCE  ( C( 3 030 ) , IM VCT  ) 

REAL»8  CPERTY,SSS 

DIMENSION  ONAME3(10) ,ONAME4(10) 

DIMENSION  LISTN0(50),  VALUE(50) 

DIMENSION  SUBNO(99) ,IR(4) ,VR(4) 

DIMENSION  ALPHA(4  ) ,0NAMEU50)  ,0NAME2(50)  ,OUTNU(50)  ,MODNO(99) 
DIMENSION  K(3510) 

DIMENSION  VLABLE(2, 15) 

DIMENSION  0UTPLT(15) 

DIMENSION  SIGMA(40) ,SIGLB(40) , SIGUB( 4 0 ) , ISNDX ( 4 0 ) , IDIST ( 40 ) 
DIMENSION  TSGMA(IO) ,TLB( 10) , TUB( 1 0 ) , ITNDX( 1 0 ) , ITDIST ( 1 0 ) , 
*TSPEK(10) ,TYPPER{10) ,TPSIG(10) ,ITNDX2(10) ,TNXST(10) 

DIMENSION  IMVNDX(IO) 

DIMENSION  CEPSIG(6) 

INTEGER  CEPSIG 
REAL  KSSIG 
REAL  MODNO 
INTEGER  OUTNO 
INTEGER  OUTPLT 

DIMENSION  C0EFF(28) ,REF(28) ,BREF(28) ,ATD(5) ,BATD(5) , DTA( 4 ) , BDTA ( 4 ) 
EQUIVALENCE  ( C( 3 359 ) , COEFF ( 1 ) ) 

EQUIVALENCE  ( C(  3387  ) , REF( 1 ) ) 

EQUIVALENCE  ( C( 34 1 5 ) , BREF( 1 ) ) 

EQUIVALENCE  ( C( 3443 ) , ATD( 1 ) ) 

EQUIVALENCE  ( C ( 3448 ) , BATD ( 1 ) ) 

EQUIVALENCE  ( C( 3453 ) , DT A ( 1 ) ) 

EQUIVALENCE  ( C( 3457 ) , BDTA( 1 ) ) 
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NAMELIST  /DAP/COEFF , REF , BHEF , ATD, BATD , DTA , BDTA 
DATA  CPERTY/8HR  / 

DATA  SSS/8HS  / 

JAR  = 0 
WRITE(6,31) 

31  FORMATd  IHIINPUT  DATA/) 

1 READ(5,2, END=50)IR(1 ) ,( ALPHA( JC) , JC = 1 , 4 ) , IR (2 ) , IR ( 3 ) , TPER , TPSGMA , 
»VR(1 ) ,VR(2) ,VR(3) ,IR(M) ,VR(4) 

55  CONTINUE 

WRITE(6, 30)IR(1 ) ,( ALPHA (JC) , JC = 1 , 4 ) , IR (2 ) , IR ( 3 ) , TPER , TRSUMA , 
»VR(1) ,VR(2) ,VR(3) , 

*IR{4) ,VR(4) 

30  FORMATCIX, I2,4A4,I5, I2,A1 ,F5.2,2E15.7,F10.4,I5,F7.4) 

2 F0RMAT(I2, 4A4, 15, 1 1 , A 1 , F3 • 2 , 2E 1 5 . 7 , F 1 0 . 4 , 15 , F5 . 2) 

7 IF(  IR(1 ) .NE.  1 ) GO  TO  3 

NOSUB  = NOSUB  + 1 
SUBNO(NOSUB)  = IR(2) 

GO  TO  1 

3 IF(  IR(1 ) .NE.  2 ) GO  TO  4 
NOMOD  = NOMOD  + 1 
MODNO(NOHOD)  = IR(2) 

GO  TO  1 

4 IF(IR(1 ) .NE.  3)  GO  TO  5 
L = IR(2) 

C(L)  = VR(1 ) 

IF  (VR(2)  .Eg.  0.)  GO  TO  1 
NOLIST  = NOLIST  + 1 
LISTNO(NOLIST)  = L 
VALUE(NOLIST)  = VR(1) 

GO  TO  1 

5 IF(IR(1 ) .NE.  4)G0  TO  6 
NOOUT  = NOOUT  + 1 

IF  (NOOUT. GT. 50)  GO  TO  1 
ONAMEO(NOOUT)=ALPHA(  1 ) 

0NAME1 (N00UT)=ALPHA(2) 

0NAME2(N00UT)  = ALPHA(3) 

OUTNO(NOOUT)  = IR(2) 

GO  TO  1 

6 IF  (IR(1  ) .NE.  5)  GO  TO  16 
READ(5,DAP) 

WRITE(6,DAP) 

GO  TO  1 

16  IF  (IR(1 ) .NE.7)  GO  TO  19 
NPL0T=NPL0T+1 
IF  (NPLOT.GT. 15)  GO  TO  1 
DO  20  1=1 ,2 

20  VLABLE  ( I , NPLOT ) = ALPHA ( 1+ 1 ) 

0UTPLT(NPL0T)=IR(2) 

GO  TO  1 

19  IF(IR(1 ) .NE.B)  GO  TO  18 
IF(TP£R.EQ.SSS)  GO  TO  194 
IF( VR(4 ) .GT.O. ) GO  TO  192 
IF(IR(3) .NE.0.AND.IR(3).NE.1)  GO  TO  193 
ISGCT=ISGCT+1 
SIGMA(ISGCT)=VR(1 ) 

SIGLB(ISGCT)=VR(2) 

SIGUB(ISGCT)=VR(3) 

ISNDX(ISGCT)=IR(2) 

IDIST(ISGCT)=IR(3) 

GO  TO  1 
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18  IF(IR(1 ) .NE.  9)  GO  TO  100 
STEP  =11. 

R£AD(5,8)NP,IBVNSW,IPL0T,XLAMBD,KSSIG,(CEPSIG(I) ,1=1 ,5) ,PSIZE 
8 F0RMAT(3IA,2F10. 3,5I2,E15.7) 

GO  TO  1 

100  IF(IR( 1 ) .NE.  10)  GO  TO  191 
IMVCT  = IMVCT  + 1 

: IMVNDX(IMVCT)  = IR(2) 

GO  TO  1 

192  IF(IR(3)  .GT.5)  GO  TO  193 
ITCT=ITCT+1 

i TSGMA(ITCT)=VR(1) 

TLB(ITCT)=VR(2) 

TUB(ITCT)=VR(3) 

ITNDX2(ITCT)=IR(2) 

IF(IR(4) .GT.O)  ITNDX2(ITCT)=IR(4 ) 

ITNDX(ITCT)=IR(2) 

ITDIST(ITCT)=IR(3) 

TSPER(ITCT)=VR(4) 

TPSIG(ITCT)=TPSGMA 

TYPPER(ITCT)=0. 

IF(TPER.Eg.CPERTy)  TYPPER ( ITCT ) = 1 . 

GO  TO  1 

194  RNSTRTrVRd  ) 

GO  TO  1 

193  WRITE(6,5518) 

5518  FORMAT(1X,58HUNDEFINED  DISTRIBUTION  TYPE  NUMBER  ENTERED  - CARD  REJ 
*ECTED) 

WRITE(6,30)IR(1 ) ,(ALPHA(JC) , JC=1 ,4) ,IR(2) ,IR(3) ,TPER,TPSGMA, 

»VR(1 ) ,VR(2) ,VR(3) , 

A'  »IR(4),VR(4) 

GO  TO  1 

191  CONTINUE 

NCASE=NCASE+1 
RETURN 
50  STOP 
END 
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SUBROUTINE  OUPT2 

C OUTPUT  INITIALIZITION  SUBROUTINE  OUPT2 
COMMON  C(3830) .GRAPH 

EQUIVALENCE  ( C( 20 1 7 ) , DTCNT  ),  ( C( 3 1 67 ) , NOOUT  ), 

C (C(20m)  .ITCNT  ),  (C(2003)  ,PCNT  ), 

C (C{2018) .TAPE  ),  (C(2019) ,TAPEND) , 

C (C(2000).T  ).  (C(2021 ) .KCONV  ). 

C ( C(2008) .PLOTNO) .( C( 2009 ), NOPLOT) ,( C( 3 1 68 ), OUTNO( 1 )) , 

C (C(2004) .PPNT  ).  (C(2023) .OPOINT) 

DIMENSION  GRAPHd.  1)  , TIME  ( 300  ) , OUTNO  ( 50  ) 

INTEGER  PGCNT  . DTCNT  . OUTNO  . OPOINT 

EQUIVALENCE  ( C (1 985 ) , OUTPLT ( 1) ) 

INTEGER  OUTPLT 
DIMENSION  0UTPLT(15) 

KCONV=0 

ITCNT  = DOC  +1.0 
PCNT  = T-0. 000001 
PGCNT  = 1 

DTCNT  = (NOOUT  + 4)/5 
IF  ( ITCNT  .GE.  7)  GO  TO  2 
ITCNT  = ITCNT  + 1 
CALL  DUMPO 
C 

2 TIMEd  )=T 
OPOINT  =1 

IF(NOPLOT.EQ.O)GOTO  11 
DO  10  J=1 . NOPLOT 
K=OUTPLT(J  ) 

10  GRAPHCI . J)=C(K) 

11  CONTINUE 
RETURN 
END 


(C(2016) .PGCNT  ). 
(C(2015),CPP  ). 

(C(2013),DOC  ). 

(C(2025) , TIMEd  ))  , 


c 


c 

c»» 


c 


c 


subroutine;  0UPT3 
OUTPUT  SUBROUTINE  OUPT3 
COMMON  C(3a30) ,GRAPH(300,4) 

COMMON/WKU 1/ONAMEO{50) 

EQUIVALENCE  ( C ( 3 1 68 ) , OUTNO ( 1) ) , ( C( 32 1 8 ) , ONAME 1 ( 1) ) , 

C (C(3268) ,ONAME2(1 ) ) , 

C (C(2017) ,DTCNT  ),  (C(3167) ,NOOUT  ),  ( C( 20 1 6 ) , PGCNT  ), 

C (C(2014) ,ITCNT  ),  ( C( 2003 ) , PCNT  ),  (C{2015),CPP  ), 

C (C(2000),T  ),  (C(2664),DER  ),  ( C( 20 1 8 ) , TAPE  ), 

C (C(2019) .TAPEND) , ( C(2008 ) , PLOTNO) , ( C( 2009 ), NOPLOT ) , 

C (C(2005),PPP  ),(C(2004),PPNT  ),( C( 2025 ), TIME ( 1 ))  , 

C (C(2023) .OPOINT) 

EQUIVALENCE  ( C( 1 985 ) , OUTPLT ( 1 ) ) 

DIMENSION  B ( 50 ) ,OUTNO(50) , ONAME 1(50) ,0NAME2(50) 

DIMENSION  TIME(300) 

DIMENSION  0UTPLT(15) 

INTEGER  DTCNT, PGCNT, OUTNO 
INTEGER  OPOINT 
INTEGER  OUTPLT 
DATA  DERI/0.0/ 


SAVE  SPOT  JITTER  MAX/MIN  VALUES 
IF(C(1680).GT.C(1567))  C(1567) 
IF(C(  1680) .LT.C( 1568) ) C(  1568) 
IF(C(1681 ) .GT.C( 1577))  C(1577) 
IF(C( 1681 ) .LT.C(  1578) ) C(  1578) 


C( 1680) 
C( 1680) 
C(  1681 ) 
C( 1681  ) 


IF  (ITCNT,  GT.  6)  GO  TO  7 
ITCNT  = ITCNT  + 1 
CALL  DUMPO 
PGCNT  = 1 


7 IF  (DER.  EQ.  DERI ) GO  TO  8 
DERI  = DER 
WRITE(6,20)T,DER 

20  FORMATCIH  ,5UTIME=,  F 1 4 , 7 , 2X , 1 0HSTEP  SIZE= , 1 PE  1 9 • 7 ) 

8 IF  (T  .LT.  PCNT)G0T015 

9 PCNT  = PCNT  + CPP 

IF  (PGCNT . NE.  1 ) GO  TO  3 
IF(N0UUT.LE. 1 ) GO  TO  3 

1 WRITE(6,2)  (ONAMEO(I)  .ONAMEKI)  ,0NAME2(I)  , I = 1,N00UT) 

2 FORMAT  ( 1H1 , 3X , 4HTIME , 5X , 5 (7X , 3A4 ) // ( 20X , 3A4 , 7X , 3A4 , 7X , 3A4 , 7X , 
13A4,7X,3A4)/) 

PGCNT  = 2*DTCNT  + 4 

3 IF(PGCNT  .G£,  86)  GO  TO  1 
DO  4 I = I.NOOUT 

J = OUTNO(I) 

4 B(I)  = C(J) 

IF(NOOUT.LE.  1)  GO  TO  15 

WRITE  (6,5)  T,(B(I),  I z I.NOOUT) 

5 FORMAT  (///,F14.7, 1P5E19.7/(14X,  1P5E19.7)) 

PGCNT  z PGCNT  + DTCNT  4 

15  IF ( T. LT. PPNT. OR. NOPLOT. EQ. 0) RETURN 
PPNTzPPNT+PPP 
KPOINT  zOPOINT  +1 
IF  (KPOINT-300)  16,13,18 

13  WRITE  (6,14) 

14  FORMAT  (//MH  **•*  WARNING-PLOTTING  ARRAY  FILLED-ONLY  FIRST  300  P 
COINTS  PLOTTED  »*»»,//) 
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16  OPOINT=KPOINT 
TIME  (OPOINT)=T 
IF(NOPLOT.EQ.O)GOTO  11 
DO  10  J = 1 , NOPLOT 
K=OUTPLT(J  ) 

10  GRAPHCOPOINT  ,J)=C(K) 

11  CONTINUE 
18  RETURN 

END 
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I I 

1 

SUBROUTINE  STGE2 
COMMON  C(3830) 

EQUIVALENCE  ( C(20 1 1 ) , KSTEP  ),  ( C( 2020 ) , LCON V ),  ( C( 202 1 ) , KCON V ) 

KCONV  = 0 
LCONV  = 0 
KSTEP  = 1 
RETURN 

[ END 
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SUBROUTINE  STGE3 
COMMON  C(3830) 

EQUIVALENCE  (C(2000),T  ), 

EQUIVALENCE  ( C( 20 1 0 ) , STEP  ), 
EQUIVALENCE  ( C( 202 1 ) , KCON V ), 
EQUIVALENCE  ( C( 2663 ) , HMAX  ), 
EQUIVALENCE  (C(2865),EU  ), 

EQUIVALENCE  ( C ( 1 973 ) , KASE  ), 
DIMENSION  DER(IOI)  , 

EXTERNAL  AUXSUB 
CALL  04 


(C(2001),TF  ), 

(C(201 1 ) ,KSTEP  ), 
(C(2561),N  ), 

(C(2664) ,DER(1  ))  , 
(C(2965) ,VAR(1  )) 
(C(1974),NJ  ), 

VAR(IOI)  , 


IF  (ABS(  T-TF)  .LE.  0.01  ) GO  TO  20 
IF  ( (TF-T)  .LT.  0. ) GO  TO  10 
IF  (LCONV  .EQ.  2)  GO  TO  20 
IF  (LCONV  ,EQ.  1)  GO  TO  10 
IF(DER(1)  .LT.  0.)  DER(1)=-DER(1)».5 
RETURN 

10  IF(DER(1)  .GT.  0.)  DER ( 1)  = -DER ( 1 ) » . 5 
KCONV  = KCONV  + 1 
IFCKCONV  .GE.  10)  GO  TO  20 


RETURN 

20  PCNT  = 1.0 

IF(STEP  . EQ. 1 1 . )GOTO  40 
PREDER  = DER( 1 ) 

DER( 1 ) = 0. 

NJ=N-1 


NPT=0 

CALL  AMRK(AUXSUB) 
DER( 1 ) = PREDER 
40  CALL  0UPT3 
KSTEP  = 2 
RETURN 


END 


(C(2003) ,PCNT  ) 
(C(2020) .LCONV  ) 
(C(2662) ,HMIN  ) 
(C(2765) ,EL(1  )) 

(C(1975),NPT  ) 
EL(IOO) 
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SUBKOUTINE  SUBL2 


1 


COMMON  C(3830) 

EQUIVALENCE  ( C(  246  1 ),  NOSUB  ),  ( C(  2462  ) , SUBNOd  ) ) 
DIMENSION  SUBNO(99) 

DO  1 I = 1,  NOSUB 
J = SUBNOd) 

GO  TO  ( 1,  2,  3,  4,  5,  6,  7,  8,  9 ),  J 

2 CALL  INPT2 
GO  TO  1 

3 CALL  OUPT2 
GO  TO  1 

4 CALL  STGE2 
GO  TO  1 

5 CALL  CNTR2 
GO  TO  1 

6 CALL  RNDM2 
GO  TO  1 

7 CALL  AUXA2 
GO  TO  1 

8 CALL  AUXB2 
GO  TO  1 

9 CALL  AUXC2 
1 CONTINUE 

RETURN 

END 


■ 
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SUBROUTINE  SUBL3 
COMMON  C(3830) 

EQUIVALENCE  ( C(246 1 ), NOSUB  ),  ( C( 2462 ) , SUBNO ( 1 ) ) 
DIMENSION  SUBNO(99) 

DO  1 I = 1 , NOSUB 
J = SUBNO(I) 

GO  TO  ( 1,  2,  3,  5,  6,  7,  8,  9 ),  J 

2 CALL  INPT3 
GO  TO  1 

3 CALL  OUPT3 
GO  TO  1 

4 CALL  STGE3 
GO  TO  1 

5 CALL  CNTR3 
GO  TO  1 

6 CALL  RNDM3 
GO  TO  1 

7 CALL  AUXA3 
GO  TO  1 

B CALL  AUXB3 
GO  TO  1 
9 CALL  AUXC3 
1 CONTINUE 
RETURN 
END 
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SUBROUTINE  SI 
C»»SEEKER  MODULE 


C 


COMMON  C(3830) 

EQUIVALENCE  (C(2000),T  ) 


101  FORMAT 

(30U0 

TARGET  ACQUISITION 

T 

= 

,F8.4, 

» 

10H 

EPS 

Z = , 1PE1 1 . 3, 10H 

EPS 

Y 

= , 1PE1 1 . 3) 

102  FORMAT 

(30H0 

PITCH  PLANE  TRACK 

T 

00 

• 

» 

10H 

EPS 

Z = , 1PE1 1 . 3, 10H 

EPS 

Y 

= , IPE1 1 . 3) 

103  FORMAT 

(3OHO 

YAW  PLANE  TRACK 

T 

r 

,F8.4, 

• 

lOH 

EPS 

Z = , 1PE1  1 . 3, 10H 

EPS 

Y 

= ,1PE11.3) 

C»»INPUT  DATA 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

EQUIVALENCE 

C 


(C( 

445) 

,RLOCK 

) 

(C( 

446) 

,DT 

) 

(C( 

447) 

,BDB 

) 

(C( 

448) 

,CFOVZ 

) 

CC{ 

449) 

,CFOVY 

) 

(C( 

450) 

,GSX 

) 

(C( 

451  ) 

,SEPS 

) 

(C( 

452) 

,SWP 

) 

(C( 

453) 

, RBK 

) 

(C( 

454) 

,GEO 

) 

(C( 

455) 

,OPTNSK 

) 

(C( 

0456) 

,GS 

) 

(C( 

0457) 

,WSL 

) 

(C( 

0458) 

,WSN 

) 

{C( 

0459) 

,WL2 

) 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

C 

C«»INPUTS  FROM  OTHER 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

equivalence. 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

c 

(C( 

C»»STATE  VARIABLE 

OUT 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

EQUIVALENCE 

(C( 

C»»OTHER  OUTPUTS 

460) , ST  ) 

461) , CAGE  ) 

462) ,TKRZ  ) 

463) ,TKRY  ) 

464) ,TRKZY  ) 

MODULES 

0371) , RANGE  ) 

0372) , RXBA  ) 

0373) , RYBA  ) 

0374) , RZBA  ) 
1739), WP  ) 
1743), WQ  ) 
1747), WR  ) 

PUTS 

0408), WLQD  ) 

0411) , WLQ  ) 

0412) , WLRD  ) 

0415) , WLR  ) 

0416)  ,WLQSD  ) 

0419) , WLQS  ) 

0420) ,WLRSD  ) 

0423) , WLRS  ) 

0424)  ,BTHTGD) 

0427) ,BTHTG  ) 

0428)  ,BPSIGD) 
0431),BPSIG  ) 
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EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 
IF(C(899) .GT 


(C(1 1 ) ,BY) 

(C(12) ,BZ) 
(C(0403) ,WLAMQ  ) 
(C{0407) ,WLAMR  ) 
(C(0435) ,BEPSZ  ) 
(C(0436) ,BEPSX  ) 
(C(0437),WZ  ) 

(C(0438),WY  ) 

(C(0439) .BGDEFL) 
(C(  465),  SDY) 
(C(  466),  SDZ) 
.0. 0)RETURN 


‘^DIRECTION  COSINES  FOR  BODY  TO  PLATFORM 
BTACT  = BTHTG 
BPACT  = BPSIG 
UCT=COSD(BTACT) 

UST=SIND(BTACT) 

UCP=COSD(BPACT) 

USP=SIND(BPACT) 

UBII  = UCT»UCP 
UB12  = UCT*USP 
UB13  =-UST 
UB21  =-USP 
UB22  = UCP 
UB23  = 0. 

UB31  = UST*UCP 
UB32  = UST*USP 
UB33  = UCT 

**  CALCULATE  TOTAL  DEFLECTION  OF  GIMBALS 
BGDEFL=SQRT(BTHTG»*2+BPSIG»*2) 

►“TRANSFORM  LOS  FROM  BODY  TO  GIMBAL  AXES 
RXO  = UB1 1»RXBA+UB12*RYBA+UB13*RZBA 
RYG  = UB21»RXBA+UB22*RYBA+UB23“RZBA 
RZG  = UB31 *RXBA+UB32*RYBA+UB33*RZBA 

‘»LOS  ERRORS  IN  PLATFORM  COORDINATES 
BEPSZ  = ATAND(-RZG, RXG) 

BEPSY  = ATAND(  RYG, RXG) 

‘“SEEKER  OUTPUT  SIGNALS 

IF(C(1976) .LE.O.)  go  TO  82 
IF(T.LT.(ST-. 000001))  GO  TO  82 
IF( C( 13) .LE.O. ) GO  TO  820 
C(13)  = -1 . 

ST  = T 

C(2664)  = DT  / AINT(DT  / C(2764)) 
820  CONTINUE 

ST  = ST  + DT 

‘“VIDICON  TRACKER 

IF(OPTNSK  .LE.  0.  ) GO  TO  85 

WLAMQ  = GEO  * BEPSZ 

WLAMR  = GEO  * BEPSY 

rfQP  = WLAMQ 

WRP  = WLAMR 

GO  TO  30 

‘“QUADRANT  TRACKER 
85  CONTINUE 


PLATFORM  TRANSFORMATION 


0.  ) 
BEPSZ 
BEPSY 


GO  TO 


I 

J 


r 


IF  (RANGE  .GT.  RLOCK)  GO  TO  81 
CZ  = 2. »BEPSZ/CFOVZ 
CY  = 2.»BEP3Y/CFOVY 
IF  (CZ»*2  .GT.  l.-CY»»2)  GO  TO  81 
BZ  = SIGNCI . ,BEPBZ) 

BY  = SIGNCI . .BEPSr) 

TKDB  = BDB/2.»(RANGE/32810. )*»2 
IF  ( ABS(BEP3Z) .LT.TKDB)  BZ  = 0. 

IF  (ABS(BEPSK) .LT.TKDB)  BY  = 0. 
CALL  QD 

IF  (CAGE  .GT.  0. ) GO  TO  82 
UZ  = BZ 
UY  = BY 
CAGE  = 1. 

WRITE(6,101)  T,  BEPSZ,  BEPSY 
GO  TO  82 

81  BZ  = 0. 

BY  = 0. 

C*»SEEKER  COMPENSATION 

82  IFCOPTNSK  . GT . 0.)  GO  TO  30 
WLAMQ  = BZ  * GS 

WLAMR  = BY»GS 
WQP  = WLAMQ 

WRP  = WLAMR 

IF  CWSL  .LE.  0.)  GO  TO  83 
WLQD  = WLAMQ 
WLRD  = WLAMR 
WLQD  = WLQD  + SEPS 
WLRD  = WLRD  + SEPS 
WQP  = WLQD/WSL  + WLQ 

jv/.  WRP  = WLRD/WSL  + WLR 

S*-,  WLAMQ  = WQP 

WLAMR  = WRP 

IF  ( WSN  . LE.  0. ) GO  TO  83 
WLQSD  = WSN*(WQP  - WLQS) 

WLRSD  = WSN*(WRP  - WLRS) 

WQP  = WLQSU/WL2  + WLQS 

WRP  = WLRSD/WL2  + WLRS 

C««SEEKER  SWITCHING  LOGIC 

83  IF  (CAGE  . LE.  0. ) GO  TO  30 
C PITCH  PLANE 

10  IF  (TKRZ  .GT.  0.)  GO  TO  20 
IF  (BZ»UZ  .GE.  0. ) GO  TO  12 
TKRZ  - 1. 

WRITE(6,102)  T,  BEPSZ,  BEPSY 
GO  TO  20 

12  WLAMQ  = BZ*GSX 
WQP  = WLAMQ 
WLQD  = 0. 

WLQSD  = 0. 

UZ  = BZ 
C YAW  PI  A NF 

20  IF  (TKRY  .GT.  0. ) GO  TO  30 
IF  ( BY*UY  .GE.  0. ) GO  TO  22 
TKRY  = 1. 

WRITE(6,103)  T,  BEPSZ,  BEPSY 
GO  TO  30 

22  WLAMR  = BY»GSX 
WRP  = WLAMR 
WLRD  = 0. 


113 


L 


o o 


WLRSD  = 0. 

UY  = BY 
30  CONTINUE 

»»MISSILE  BODY  RATES  IN  GIMBAL  AXES 
WZ  = UB31*WP+UB32*WQ+UB33*WR 
WY  = UB21*WP+UB22»WQ+UB23*WR 
C 

C»»GIMBAL  COUPLING 

UZK  = SWP*(-BTHTG  + .1»BPSIG) 
UYK  = SWP*(-BPSIG  - .1*BTHTG) 
UZK  = UZK  + SDZ 
UYK  = UYK  + SDY 
C 

C»*GIMBAL  ANGLE  DERIVATIVES 

BTHTGD  = WQP  + UZK  - WY 
BPSIGD  = WRP  + UYK  - WZ/UB33 
C 

IF  (CAGE  .GT.  0.)  RETURN 
WLAMQ  = 0. 

WLAMR  = 0. 

WLQD  = 0. 

WLRD  = 0. 

WLQSD  = 0. 

WLRSD  = 0. 

BTHTGD  = 0. 

BPSIGD  = 0. 

RETURN 

END 
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SUBROUTINE  S1I 
C»*SEEKER  INIT. MODULE 
COMMON  C(3830) 

DIMENSION  IZ(50),  IY(50),  ISNDX(40) 

EQUIVALENCE  (C(3634),  ISNDX(I)),  (C(3512),  13512) 
EQUIVALENCE  (C(  470),  BTGERR) 

EQUIVALENCE  (C(  471),  BPGERR) 

EQUIVALENCE  (C(  465),  SDY) 

EQUIVALENCE  (C(  466),  SDZ) 

1 F0RMAT(5X,2HBZ,6X,4(I13,I11)/(13X,4(I13,I11))) 

2 FORM AT ( 5X , 2H B Y , 6X , 4 ( I 1 3 , 1 1 1 ) / ( 1 3X , 4 ( I 1 3 , 1 1 1 ) ) ) 
EQUIVALENCE  (C( 1 1 ) ,BY) 

EQUIVALENCE  (C(12),BZ) 

EQUI VALENCE (C{ 201 1 ) ,KSTEP) 

EQUIVALENCE(C(600)  , IZ( 1 ) ) 

EQUI VALENCE (C(6 50 ) ,IY( 1 )) 

DIMENSION  IPL(IOO) 

EQUIVALENCE  (C(452),SWP) 

EQUI VALENCE (C( 041 1 ) ,WLQ) 

EQUIVALENCE(C(0415) ,WLR) 

EQUIVALENCE  ( C( 04 1 9 ) , WLQS ) 

EQUIVALENCE  ( C( 0423 ) , WLRS ) 

EQUIVALENCE  ( C( 0427 ) , BTHTG ) 

EQUIVALENCE  ( C( 04 3 1 ) , BPSIG ) 

EQUIVALENCE  (C(2561),N) 

EQUIVALENCE  ( C{ 2562 ) , IPL ( 1 ) ) 

EQUIVALENCE  ( C( 3504 ) , 0PTN4 ) 

EQUIVALENCE  (C(2662)  ,DERSV) 

IPL(N )=424 
IPL(N+1 )=42B 
IPL(N+2)=408 
IPL(N+3)=412 
IPL(N+4)=416 
IPL(N+5)=420 
N=N+6 
C(41 1 ) = 0. 

C(415)=0. 

C(419)=0. 

C(423)=0. 

BY=0. 

BZ  = 0. 

SDY  = 0. 

SDZ  = 0. 

DO  10  I = 1,  13512 
IDO  = I 

MONTE  CARLO  SEEKER  OUTPUT  STARTING  VALUES 

IF(  ISNDXd  ) .EQ.  n ) CALL  MCARLO  (DUM,  1,  IDO) 
IFdSNDXd ) .EQ.  12)  CALL  MCARLO  (DUM,  1,  IDO) 
IFCISNDXd)  .EQ.460)  CALL  MCARLO  (DUM,  1,  IDO) 

IF( ABS(BY) .GT.O.  ) BY  = SIGN(1.,BY) 

IF(ABS(BZ) .GT.O.  ) BZ  = SIGN(1.,BZ) 

MONTE  CARLO  SEEKER  POINTING  ERROR 

IFdSNDXd)  .EQ.  470)  CALL  MCARLO  (DUM,  1,  IDO) 
IFdSNDXd)  .EQ. 471  ) CALL  MCARLO  (DUM,  1,  IDO) 
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C »»  MONTECARLO  SEEKER  DRIFT 

IFdSNDXd)  .EQ.  465)  CALL  MCARLO  (DUM,  1,  IDO) 
IFdSNDXCl)  .EQ.466)  CALL  MCARLO  (DUM,  1,  IDO) 
C 

10  CONTINUE 

BTHTCj  = BTHTG  + BTGERR 
BPSIG  = BPSIG  + BPGERR 
C 

WLOS=SWP«(BTHTG-BPSIG) 

WLQ=SWP»(BTHTG-BPSIG) 

WLR=SWP«(BTHTG+BPSIG) 

WLRS=SWP»(BTHTG+BPSIG) 

C(13)  = -1 . 

DERSV=.002 
C(461  )=0. 

C(462)=0. 

C(463)=0. 

C(464)=0. 

IF(0PTN4.GT. 1 .)  GO  TO  30 
C(461 )=1 . 

C(462)  = 1 . 

C(463)  = 1 . 

C{464)=1 . 

30  CONTINUE 
NI  = 1 
MI  = 1 
SET=0. 

DO  200  1=1,50 
IZd)  = 0 
200  IYd)  = 0 
RETURN 
ENTRY  QD 

IFCSET.GT.O. ) RETURN 
IF(NI.GT.50)  RETURN 
IF(MI.LE. 10)  GO  TO  100 
NI=NI+1 
MI  = 1 

100  IZ(NI)=IZ(NI)+INT(BZ+2. )*10»»(10-MI) 
IY(NI)=IY(NI)+INT(BY+2. )*10**(10-MI) 

MI=MI+1 
RETURN 
ENTRY  S8 

IFCSET.GT.O. .0R.KSTEP.NE.2)  RETURN 
SET= 1 . 

WRITE(6,1)  dZd),I  = 1,NI) 

WRITE(6,2)  dYd),I  = 1,NI) 

RETURN 

END 


SUBROUTINE  TABLE  (X , XI , YI , NX , XK , XLABEL , Y ) 
DIMENSION  XKNX)  ,YI(NX) 

XK  = 0, 

Y = FINTP1  (X, XI, YI, NX, XK, XLABEL) 

RETURN 

END 
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SUBROUTINE  TABL2 (X , Y , XI , YI , Z I , NX , NY , NXY , XINTER , XLABEL , Z ) 
DIMENSION  XI(NX)  ,YI(NY)  ,ZI(NXY) 

Z=FINTP2(X, Y, XI ,YI,Z I, NX, NY, NXY, XINTER, XLABEL) 

RETURN 

END 


I 


L 


SUBROUTINE  TIMEV(XPDQ) 

DIMENSION  IC(6)  ,X(100)  ,Y(100)  ,YU2,4)  ,T1(300) 
DUMMY  SUBROUTINE 


ENTRY 

A2I 

ENTRY 

A4 

ENTRY 

A4I 

ENTRY 

A5 

ENTRY 

A5I 

ENTRY 

C2 

ENTRY 

C2I 

ENTRY 

C6 

ENTRY 

C6I 

ENTRY 

C7 

ENTRY 

C7I 

ENTRY 

C8 

ENTRY 

C8I 

ENTRY 

C9 

ENTRY 

C9I 

ENTRY 

CIO 

ENTRY 

C10I 

ENTRY 

D3 

ENTRY 

D3I 

ENTRY 

D4 

ENTRY 

D4I 

ENTRY 

D5 

ENTRY 

D5I 

ENTRY 

01 

ENTRY 

Oil 

ENTRY 

031 

ENTRY 

041 

ENTRY 

051 

ENTRY 

06 

ENTRY 

061 

ENTRY 

S5 

ENTRY 

S5I 

ENTRY 

S6 

ENTRY 

S6I 

ENTRY 

S7 

ENTRY 

S7I 

ENTRY 

S8I 

ENTRY 

S9 

ENTRY 

S9I 

ENTRY 

SIO 

ENTRY 

S10I 

ENTRY 

AUXA1 

ENTRY 

AUXA2 

ENTRY 

AUXA3 

ENTRY 

AUXB1 

ENTRY 

AUXB2 

ENTRY 

AUXB3 

ENTRY 

AUXC1 

ENTRY 

AUXC2 

ENTRY 

AUXC3 

ENTRY 

CNTRl 

ENTRY 

CNTR2 

ENTRY 

CNTR3 

ENTRY 

INPT1 

ENTRY 

INPT2 

ENTRY 

INPT3 

J 
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ENTRY  NORMAL(RX,XL,XU,XM,SG,RN) 

ENTRY  OUPTl 
ENTRY  PROCES 
ENTRY  RANNUM(R,S,T) 

ENTRY  RNDM1 
ENTRY  RNDM2 
ENTRY  RNDM3 
ENTRY  STGEl 
ENTRY  KIKSET 
ENTRY  COUNTV 
ENTRY  WRITE 
GOTO  2 

ENTRY  MCARLO(R,M,I) 

■ . GOTO  2 

( ENTRY  AERROR(XL) 

^ GO  TO  2 

i ENTRY  TERROR(XL) 

I CALL  EXIT 

; ENTRY  CEPAS(N,I,IP,XL,S,IC,P) 

i ENTRY  CEPP(X,Y,N,S,X1 ,I,1C,IP,P) 

! ENTRY  NORM(R,X1,XU,XM,S,R1) 

I ENTRY  KSTEST(Y,N,S,X1,SX,NI) 

ENTRY  ZTABLE(Z,F,N) 

ENTRY  PPLOT(X,Y,N,C,I,R,T,XB,YB,XL,P) 
ENTRY  XLOC(X1,H,I,IN) 

1GOTO  2 

ENTRY  G2 
ENTRY  G2I 
ENTRY  S4 
ENTRY  S4I 
ENTRY  C5 

i ENTRY  C5I 

ENTRY  RESET 
GOTO  2 

ENTRY  PLOT4(G,N,Y1 ,T1 ,NP,NL,NO) 

ENTRY  S2 
ENTRY  S3 
ENTRY  PLOT2 
ENTRY  PLOTN 
ENTRY  MCARLX 
ENTRY  SUBLl 
2 CONTINUE 

I RETURN 

( END 


oo  no  o non  o o n oooooonoonooooonooooooo 


SUBROUTINE  WKPLOT 


PRINTER  PLOTS  OF  SPECIFIED  VARIABLES  AGAINST  TIME  AND  AGAINST 
EACH  OTHER. 

..MAXIMUM  OF  4 DEPENDENT  VARIABLES  PLOTTED  AGAINST  TIME 
..IN  PAIRED  PLOTS,  FIRST  VARIABLE  IN  PAIR  IS  ASSUMED  TO  BE 
THE  INDEPENDENT  VARIABLE. 

POINTS  PLACED  IN  WKU.YORK  ON  DPC002.  ACTUAL  PLOTTING  DONE  BY 
NEXT  JOB  STEP 

VARIABLES: 

NOPLOT-C(2009)-//PLOTS 

NPLOT-C( 1984)-#PL0TS-C0MPUTED-??? 

VLABLE(2, 15)-C(2325)-8  CHARACTER  AXIS  NAMES 

OUTPLT(15)-C( 1 985)-C  ARRAY  INDICIES  OF  VARIABLES  TO  BE  PLOTED 
GRAPH(300,4)-P0INTS  TO  BE  PLOTTED 
TIME(300)-C(2025)-PLOT  TIME  INTERVALS 
OPOINT-C(2023)-//POINTS  TO  BE  PLOTTED 
PLOTN2-C(  1983)-//PAIRED  PLOTS-INPUT 
PPP-C(2005)-WIDTH  OF  TIME  SAMPLE  INTERVAL-INPUT 
PPNT-C(2004)-TIME  PLOTTING  IS  BEGUN-INPUT 

COMMON  C(3830) ,GRAPH(300, 4) 

EQUIVALENCE  ( C( 2009 ), NOPLOT ) , ( C( 1 984 ) , NPLOT ) , ( C( 1 983 ) ,PL0TN2) , 
.(C(2325)  .VLABLEd  , 1 )),(  C(  1 985  ), OUTPLT  ( 1 )),(  C ( 2025 ),  TIME ( 1) ) , 

. (C(2023) ,OPOINT) , ( C( 2005 ) , PPP ) ,(C(2004) ,PPNT) 

INTEGER  OPOINT, NOPLOT, NPLOT, OUTPLT (15) 

DIMENSION  VLABLE(2, 15) ,TIME(300) 

N AMELIST/TEST/NOPLOT, NPLOT, PLOTN2, VLABLE, OUTPLT, OPOINT, PPP, PPNT, 
.GRAPH 


DEFINE  FILE  8 ( 1 400 , 80 , E , NPOINT ) 


OUTPUT  GRAPH  LABELS 
NOPLOT=NPLOT 
NPL2=  PLOTN2 

WRITE(8 ' 1 , 10)  NOPLOT, OPOINT, NPL2 

10  F0RMAT(3I3) 

IFCNOPLOT  .£Q.  0)  RETURN 

PLACE  TIME  ARRAY  IN  FILE 
DO  14  J=1 , OPOINT 
14  (i/RITE(8 ’NPOINT,  1 1 ) TIME(J) 

11  FORMAT(E15.7) 


TIME  VS.  ---  PLOTS 
DO  4 1=1 , NOPLOT 
IF(I.GT.4)  WRITE(6,6) 
IF(I.GT.4)  RETURN 
6 FORMAT( 'OWARNING. . I>4 . . 
./,’  ' , 80('«'  )) 

PLACE  DEPENDENT  VARIABLE  IN 
DO  5 J = 1 , OPOINT 


YOU  CANNOT  HAVE  MORE  THAN  4 TIME  PLOTS' 


FILE 
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5 WRITE(8’NP0INT,11)  GRAPH(J,I) 

WRITE(8 ’NP0INT,2)  VLABLE ( 1 , I) , VLABLE (2 , I ) 
2 F0RMAT(2A4) 

4 CONTINUE 

WRITE(6,8) 

8 FORMAK 'OPLOT  POINTS  PLACED  IN  WKU.YORK') 
RETURN 
END 


T 


1 


SUBROUTINE  ZERO 
COMMON  C(3830) 

EQUIVALENCE  ( C( 1 984 ) , NPLOT  ) 

EQUIVALENCE  ( C( 2023 ) , OPOINT ) 

EQUIVALENCE  ( C( 236 1 ) , NOMOD  ) 

EQUIVALENCE  (C(246l ),  NOSUB  ) 

EQUIVALENCE  (C( 3066) , NOLIST) 

EQUIVALENCE  ( C( 3 1 67 ) , NOOUT  ) 

INTEGER  OPOINT 

NOSUB  = 0 

NOMOD  = 0 

NOOUT  = 0 

NOLIST  = 0 

0P0INT=0 

NPLOTrO 

RETURN 

END 
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ABSTRACT 

A suboptimal  terminal  guidance  law  for  a tactical  guided  missile 
was  derived  using  a system  of  state  equations  describing  the  geometric 
and  dynamic  conditions  of  the  missile-target  closure.  The  problem  was 
formulated  to  minimize  a linear  quadratic  performance  index  with  con- 
straints at  final  time.  Initially,  the  autopilot  implementation  assumed 
an  ideal  instantaneous  response.  This  assumption  was  then  removed, 
and  the  resulting  configuration  was  investigated  for  various  lag  times. 
As  would  be  expected,  the  control  laws  derived  with  the  simplifying 
assumptions  removed  were  much  more  complex.  However,  it  was  noted  that 
in  the  limiting  case,  when  the  autopilot  time  lag  tended  to  zero,  a 
simpler  control  law  surfaced.  Comparisons  were  made  then  of  the  miss 
distance  and  attitude  angle  at  impact  with  varying  lag  conditions.  It 
was  decermined  that  the  suboptimal  control  law  was  extremely  sensitive 
to  various  approximations,  especially  linear  subarcs  or  constants,  for 
the  time  varying  gains. 

I.  INTRODUCTION 

Recent  intelligence  suggests  that  the  impenetrable  nature  of 
heavy  armor  may  be  susceptible  to  missile  attacks  at  a relatively  high 
angle  of  impact,  with  respect  to  the  horizon.  In  many  modes  of  direct 
encounter,  the  target  may  not  be  reachable  with  a body  pitch  attitude 
angle  of  the  proper  magnitude.  There  are  several  possible  reasons  for 
this  condition  including  lack  of  energy  (fuel),  lack  of  time  to  maneuver 
into  the  more  desirable  attitude,  or  lack  of  control  information  by 
appropriate  sensors  to  command  the  response.  This  condition  has  been 
recognized  for  some  time  at  the  Missile  Research  and  Development  Command 
and  consequently  there  have  been  attempts  to  modify  trajectory  shapes 
by  a variety  of  predetermined  control  laws.  However,  there  has  been  a 
certain  lack  of  robustness  in  the  solutions  obtained  over  the  entire 
range  of  conditions  anticipated. 
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This  situation  motivated  a search  for  optimal  solutions  Co  the 
guidance  problem  and  a study  of  tradeoffs  among  the  suboptimal  candi- 
dates which  were  deemed  feasible. 

Terminal  guidance  schemes  for  tactical  missiles  may  be  based  on  a 
classical  approach,  such  as  a proportional  navigation  and  guidance  law 
[3,4],  or  on  a modern  control  theoretic  approach  [5-8].  In  the  latter, 
a control  law  is  derived  in  terms  of  time-varying  feedback  gains  when 
formulated  as  a linear  quadratic  control  problem.  A suboptimal  terminal 
guidance  system  for  reentry  vehicles,  derived  using  the  modern  approach, 
was  the  basis  for  the  initial  work  on  this  problem. 

Kim  and  Grider  [2]  studied  a suboptimal  terminal  guidance  system 
for  a reentry  vehicle  by  placing  a constraint  on  the  body  attitude 
angle  at  impact.  Their  problem  was  oriented  to  a long  range  high 
altitude  mission.  Their  scenario  was  formulated  as  a linear  quadratic 
control  problem  with  certain  key  assumptions.  The  angle  of  attack  of 
the  reentry  vehicle  was  assumed  to  be  small  and  thus  was  neglected. 
Furthermore,  the  autopilot  response  was  assumed  to  be  instantaneous, 
i.e.,  with  no  lag  time  attributed  to  the  transfer  of  input  commands 
to  output  reaction. 

These  conditions  have  been  studied  in  an  extension  of  their  earlier 
work  [9].  A formulation  is  given  for  a system  that  has  finite  time 
delay.  In  fact,  the  increase  and  decrease  in  time  delay  has  interesting 
ramifications  on  the  solution.  The  angle  of  attack  assumption  is 
investigated,  and  though  not  solved  analytically  in  closed  form,  the 
system  is  derived. 

There  is  more  than  just  a passing  academic  interest  in  this  problem. 
As  suggested  previously,  the  antiarmor  role  of  several  Army  weapon  sys- 
tems very  well  may  be  enhanced  by  this  technique.  The  reduction  to  a 
practical  implementation  of  mechanization  will  be  studied  and  described 
in  a future  paper.  This  paper,  however,  summarizes  the  feasibility  of 
the  concept. 

II.  STATE  REPRESENTATION  AND  PROBLEM  FORMULATION 


The  geometry  of  the  tactical  missile-target  position  is  given 
in  Figure  A-1.  Assuming  that  the  angle  of  attack  is  small  and  can  thus 
be  neglected  (this  assumption  will  be  considered  later)  and  choosing 
the  following  set  of  state  variables 
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Figure  A-1.  Geometry  of  tactical  missile 

target  positioas. 


where 


= the  position  variable  from  the  missile  to  the  target, 
projected  on  the  ground 

Yj.  = the  position  variable  of  the  target 

Y^  = the  position  variable  of  the  missile  projected  on  the  ground 

Y^  = the  derivative  of  Y^,  the  missile  to  the  target  velocity 
projected  on  the  ground 

= the  lateral  acceleration  of  the  missile 

9 = the  body  attitude  angle  of  the  missile 
Q = the  angle  of  attack  of  the  missile, 
the  system  dynamics  can  be  expressed  as 
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^d-^d 

Yj  ■ -Aj^  cos  9 

(A-2) 

0 - K u 
a 

Note  that  the  lag  in  the  autopilot  has  been  represented  by  a first 
order  lag  network 

Al(s) 

u(s)  s + (A-3) 

where  u represents  the  control.  (Previous  work  [2]  assumed  immediate 
response  of  the  autopilot.) 

Linearizing  about  an  operating  point  (i.e.,  cos  0 “ b)  and  viewing 
the  system  in  the  standard  canonical  form, 

X « Ax  + Bu 


the  result  is 


0 1 0 0 Y, 


0 0 0 -b  Y 


0 0 0 e 


(A-4) 


0 0 0 0 0 A. 


This  optimal  control  problem  will  have  a controller  of  the  form 


a . t + Cj  . 0 + C . 


(A-5) 


where  C^,  C^,  C^,  are  time  varying  coefficients  chosen  to  minimize 
the  cost  functional 


J “ Y^(t  ) + /0^t  ) + p u^t)  dt 


(A-6) 
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Here 


= final  (impacc)  time 


t = initial  time 
o 

7,P  = constant  weighting  factors. 

The  integral  term  in  the  performance  index  of  Equation  (A-6)  is  used  to 
constrain  the  total  expenditure  of  u.  The  actual  constraints  on  miss 
distance  and  attitude  angle  at  impact  are: 

lY^(tpl  < 5 ft 
|0(t^)l  < 5 deg 
III.  PROBLEM  SOLUTION 

Using  the  Euler-Langrange  formulation,  a closed  form  solution 
of  the  controller,  u,  was  obtained  as: 
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The  coefficients  are  shown  in  Figures  A-2,  A-3,  A-4,  and  A-5  for 
following  parameter  values:  “ 5,  = 5,  =»  0.0005,  7 “ 3823, 

P = 0.0000694,  tj  = 7.68.  The  jinks  near  impact  time  are  characteristic 

of  the  choice  of  state  variables. 


y'  ■ 


Figure  A-2.  Time  varying  optimal  history 

of  coefficient 


and 


A = 6^  + 


t)  + 8g^(t  - C)^  + - t) 

t “I 


(A-8) 


Note  Che  relationship  between  the  two  control  laws.  As  lag  in  the  auto- 
pilot tends  to  zero  i.e,,  -*  m in  Equation  (A-7),  the  control  law  of 

Equation  (A-8)  surfaces  as  the  limiting  case  of  the  new  control  law. 

Even  though  acceptable  performace  is  obtained  using  the  control 
law  described  by  the  coefficients  in  Equation  (A-8)  there  is  some  ques- 
tion regarding  the  sensitivity  of  performance  due  to  lag.  In  particular, 
this  question  arises:  at  what  point  does  performance  degenerate  to 
justify  the  more  complex  control  law  to  achieve  the  given  performance 
constraints?  This  is  partially  answered  by  referring  to  Figure  A-6, 
which  is  a plot  of  miss  distance  versus  lag  for  the  two  control  laws, 

and  Figure  A-7  which  is  attitude  angle  at  impact  versus  lag. 
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Figure  A-6.  A comparison  of  miss  distance  performance. 


For  lag  constraints  of  = 1,  2,  the  simulation  with  the  control 

law  of  Equation  (A-8)  becomes  unstable.  This  is  not  true  with  the  law 
described  by  Equation  (A-7).  For  = 3,  a miss  distance  of  68  ft  was 

obtained  while  the  new  control  law  had  a miss  distance  of  6.1  feet. 
Acceptable  performance  for  Equation  (A-8)  is  not  obtained  until  > 4. 

It  should  be  noted  that  the  parameters  in  that  control  law  were  chosen 
for  a nominal  lag  value  of  = 5.  Should  the  amount  of  lag  in  the 

tactical  missile  autopilot  vary,  and  not  be  approximated  closely  a 
priori,  then  the  more  complicated  control  law  needs  to  be  implemented. 

In  other  words,  the  control  law  of  Equation  (A-8)  performs  adequately 
only  for  lag  near  the  assumed  nominal  value. 

The  control  law  Implementation  was  investigated  for  adaptibility 
to  approximation  signals  from  physically  realizable  sources.  The  coeffi- 
cients C^,  C^,  were  approximated  by  linear  functions  pieced  together  at 

three  break  points’.  Performance  turned  out  to  be  too  sensitive  to  the 
approximation  error,  and  the  performance  constraint  could  not  be  met. 

The  number  of  linear  segments  used  was  increased,  but  acceptable  per- 
formance still  was  not  achieved.  It  was  concluded  that  successful 
implementation  would  require  more  than  merely  linear  approximations  to 
the  time  varying  coefficients. 
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The  angle  of  attack,  probably  cannot  be  ignored  for  the  larger 
tactical  missiles.  For  such  a missile,  the  system  of  equations  should 
include  the  angle  of  attack  a.  In  addition,  because  it  is  feasible  to 
achieve  only  a small  angle  of  attack  at  impact,  a reasonable  performance 
index  to  be  minimized  would  seem  to  be: 


J 


Cj^v^(tf)  + + c^a^Ct^)  + cj^u^(t)  dt 

*"0 


(A-9) 


To  produce  a formulation  of  the  problem  which  incorporates  the 
angle  of  attack  Q,  it  is  assumed  that  O can  be  expressed  as  a linear 
combination  of  the  control  u and  the  attitude  rate  d.  Assuming  motion 
only  in  the  pitch  plane,  then 

t?  = Q (pitch  rate) 

a = Q = (TAB2  + 


where  TAB2  is  the  pitching  moment  coefficient  due  to  angle  of  attack  and 
pitch  rate,  TCB^,  is  the  pitching  moment  coefficient  due  to  fin 
deflection.  Now, 

TAB.  = -qSd(C  • a + C • Q) 

^ '"a  "'a 

or 

TAB^  = Lj^a  + , 

where 


=■  -q  • S • d • 


I 


2 


= -q  • S 


• d 


I 


2 


q = dynamic  pressure 

S = missile  reference  area 

d « missile  reference  dimension. 
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Also,  noting  pitch  fin  deflection  (&q)  is  equivalent  to  control  (u) 
TCB~  “q'S.d"*C  "U 

Therefore, 


0 - L^a  + L^e  + L^u 


where 


q • S • d 


Figure  A-1,  yields  the  following  system  for  the  state  variables 
^d’  ^d’ 


Yj  “ -Aj^  cos  (0  - a) 


-“l^L  + 


0 = 9 


0 = h^a  + L29  + L^U 


a = K^u  + K^0 


This  system  can  be  linearized  about  an  operating  point,  i.e., 
b = cos  (9  - a).  Even  so,  the  control  problem  with  the  cost  functional 
in  Equation  (A-9)  does  not  lend  itself  readily  to  a closed  form  solu- 
tion. Future  work  is  anticipated  using  computer  augmented  algorithms. 
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Appendix  B:  Four-State  Simulation  Listing 


FUNCTION  KGCTRL(GAMMA,BETA, NBASE) 

IMPLICIT  REAL»8  (A-H,0-Z) 

REAL  KGCTRL, GAMMA, BETA 
REAL  «8  K1 ,KA 
COMMON/CONSTR/CQUANT 
COMMON/YORKl/DTRK, 

C 

c»»»»integrals  for  RUNGK 

U YD, YV, THETA, HA 

//  , AL 

C»»*»dERIVATIVES  for  RUNGK 

# ,DYD,DYV,DTHETA,DHA 

» ,DAL 

C 

U ,NX,IYORK,KUTTA 
C 

SIN(X)=DSIN(X) 

COS(X)=DCOS(X) 

C 

c«»*»»kim-grider  control  law 

C1Y(OG)=(BETA»G»OG  - G*GAMMA»KA*»2»OG»»2/2 . ) /DEL 
C1YD(0G)=(-BETA*G»0G»*2+G»GAMMA»KA*»2»0G**3/2. )/DEL 
C1THET(OG)= (-BETA*GAMMA»KA-GAMMA»KA»G»»2»0G»»3/6. )/DEL 
C1AL(OG)=0. 

VMI(T)  = -39.^  » T + 1080. 

777  CONTINUE 
C998  FORMAT(3F10.0) 


777  C 
C998  F 
C ' 

(3*  »»»»• 


INPUT  VALUES  FOR  GAMMA  AND  BETA 


READ(5,998)  GAMMA, BETA 

IF(GAMMA.EQ.O. ) STOP 
PRINT  100, BETA, GAMMA 

100  FORMATCIHI , IX, ’BETA=' ,D14.6,2X, 'GAMMA=' ,D14.6) 

TF=7.0 

TIME=0. 

DT=1 ./128. 

DTRK=DT 
NX  = 5 
K 1=1. 00 
W 1=9. 80 
KA=.0005 
JPRI=10 
YD=5000.0 
VM=VMI(TIME) 

VT=0. 

AL=20. 

THDEG  = LAUNCH  ANGLE  DELO  = DESIRED  IMPACT  ANGLE 

THDEG=87.5 
DELO  = nb.O 
DELRAD=DEL0/57.296 
B = COS(DELO) 

B = 0.707107 

THETA =(THDEG-DEL0)/57. 296 
PRINT  105, GAMMA, DELO, THDEG, B 

105  FORMAT ( ' GAMMA =’ ,F10.4,2X, ’DELO= ’ , F 1 0 . 4 , 2X , ’ THETA= ',F10.4,2X,'B=', 
AF10.4) 

YV=VT-VM»SIN(THETA+DELRAD) 

HA=1000.0 


o o no  o o o 


Wr 


f 


J=20 

IF  (NBASE  .EQ.  0 ) WRITE (6 , 1 3 1 9 ) TF , K1,  W1,  YD, 

#HA, VM,B,THDEG,DELO,KA 

1319  FORMAT! ’OINITIAL  VALUES  OF  TF',G10.4,/’  K1  ',G10.5,'  W1  ',G10.5,' 

» YD  ',G10.4,'  HA  ',G10.4,'  VM  ',G10.4,'  B ’,G10.4,/'  INITIAL  THDEG 
G10.5,  'IMPACT  ANGLE  DESIRED',  G10.5,/,'  KA ' , G 1 0 . 5/ ' 0 ' ) 

2 CONTINUE 
J=J  + 1 

THDEG=THETA»57.296 
DELTH=THDEG-DELO 
XM=1 . E4-YD 
DO  10  KUTTA=1 , 4 
VM  = VMKTIME) 

G=-K1»B/W1 

TGO--HA/(VM»COS(THETA+DELRAD) ) 

DEL=BETA*»2-GAMMA»BETA»KA»»2»TGO-BETA»G«»2»TGO»»3/3.+GAMMA*G»»2*KA 

1»»2*TG0»»4/12. 

CY=C1Y(TG0) 

CYD=C1YD(TG0) 

CT=C1THET(TG0) 

CAL=C1AL(TG0) 

U=CY»YD+CYD»YV+CT*THETA+CAL»AL 

DYDrYV 

DYV=-AL»COS(THETA+DELRAD) 

DTHETA=KA»U 

DHA=-VM»C0S(THETA+DELRAD) 

DAL=-W1»AL+K1»U 
GOTO{30,50,60,40) ,KUTTA 
30  CONTINUE 
60  TIME=TIME+.5*DT 
40  CONTINUE 
50  CALL  RUNGK 
10  CONTINUE 

IF(DABS(YD)  .LT.50.)  DTRK=1./256. 

35  IF  (J.LT.JPRI)  GO  TO  3 

36  CONTINUE 

C PRINT  101 , TIME, YD, YV, THETA 

101  FORMAT('OTIME  = ='  ,F10.4,4X,'REL  DIST.  YD= ' , D 1 4 . 6 , ' REL . VEL.  YV= ' , 
1D14.6,4X, 'THETAr ' ,D14.6) 

C PRINT  102,HA,AL 

102  FORMAT!'  VERT.  HE IGHT= ' , D 1 4 . 6 , 4X , ' AL= ' , D 1 4 . 6 ) 

PRINT  103,CY,CYD,CT,CAL,U 

103  FORMAT!  IX,  'C1Y=’  ,D14.6,4).,  'C1YD='  ,D14.6,4X,  'CnHETA='  ,D14.6,4X, 
TC1AL  = ='  ,D14,6,4X,'U=',D14.6) 

J=0 

3 IF!TIME.GT.TF+.2)GOTO  8 
IF!HA.LT.O. )G0T07 

GO  TO  2 
7 CONTINUE 

THDEG=THETA»57.296 
SET  FUNCTION  AND  CONSTRAINT  VALUES 
KGCTRL  = YD*'*2  THDEG»«2 
CQUANT=0.0 

WRITE!6,  131 3)  KGCTRL, YD,  THDEG,  GAMMA,  BETA,  CQUANT 
1313  FORMAT! 'OFUNCTiUN  VALUE  ’ , G 1 5 . 7 , / ' MISS  DISTANCE ', G 1 5 . 7 ,' ANGLE :' , 
$G15.7,  / ’ GAMMA',  G15.7,  ' BETA',  G15.7,'  CQUANT ’ ,G15 . 7 ,/,' 0 ' , 
.60! '•' )) 

RETURN 

PRINT  101 , TIME, YD, YV, THDEG 
PRINT  102,HA,AL 
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b PRINT  405 

405  FORMATC  TIME  EXCEEDS  TF  ' ) 

WRITE(6, 1313)  KGCTRL.YD,  THDEG,  GAMMA,  BETA,  CQUANT 
WRITE(6, 1314) 

1314  FORMAT('ORUN  TERMINATED ',/, 4 ( ' ',  80 (’»’),/) ) 

RETURN 

END 

SUBROUTINE  RUNGK 
IMPLICIT  REAL»8  (A-H,0-Z) 

DIMENSION  X(5) ,DX(5) ,XA(5) ,DXA(5) 
COMMON/YORK1/DT,X,DX 
# ,NX, IYORK,KUTTA 
GO  TO  (10,30,50,70),KUTTA 
10  DO  20  1=1, NX 
XA(I)=XCI) 

DXA(I)=DT»DX(I) 

20  X(I)=X(I)+.5»DXA(I) 

RETURN 

30  TDT=2.*DT 
HDT=.5*DT 
DO  40  1=1 , NX 
DXA(I)=DXA(I)+TDT»DX(I) 

40  X(I)=XA(I )+HDT*DX(I ) 

RETURN 

50  DO  60  1=1 ,NX 
VDT=DT*DX(I ) 

DXA(I)=DXA(I)+2.»VDT 
60  X(I)=XA(I)+VDT 
RETURN 

70  DO  80  1=1, NX 

80  X(I)=XA(I)+(DXA(I)+DT»DX(I))/6. 

RETURN 

END 
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Appendix  C:  Determination  of  Optimal  Control  Parameters: 

An  Application  of  Mathematical  Programming 

by 

Drs.  Daniel  C.  St.  Clair  and  Randy  J.  York 
Western  Kentucky  University 

Introduction 

The  implementation  of  a control  law  in  a simulation  study  requires  that 
the  researcher  determine  apriori  the  value  of  several  control  law  parameters. 

Many  of  these  parameters  such  as  height,  weight,  distance,  velocity,  etc.  are 
determined  by  particular  test  requirements.  However,  there  may  also  be  a set 
of  parameters  which  act  as  constants  in  the  simulation  but  whose  values  are 
difficult  to  determine  apriori.  This  paper  suggests  several  easy  to  implement 
mathematical  programming  algorithms  which  can  be  used  to  produce  reliable  esti- 
mates of  such  parameters. 

Each  algorithm  presented  attempts  to  solve  the  mathematical  programming 
problem 

min  J(a)  (C-1) 

where  a represents  the  vector  of  parameters  to  be  determined  and  J(a) 
is  the  scalar  valued  function  being  minimized.  In  the  application  at  the  end 
of  the  paper, 

2 _ -2 

J(a)  = Yj  (a)  + (9(a)-eg)  (C-2) 

where  Yj(a)  is  the  missile  miss  distance,  6(n)  is  the  attitude  angle  at  impact, 
and  0^is  the  desired  attitude  angle  at  impact.  In  that  example,  each  determination 
of  J(a)  required  execution  of  the  control  law  simulation  program. 

In  the  next  section,  the  computational  approach  to  solving  (1)  is  given 
along  with  the  description  of  several  nonlinear  programming  algorithms. 

References  to  both  original  works  and  works  containing  additional  test  results 
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are  provided  to  assist  the  reader  in  easy  implementation  of  the  algorithms. 
The  third  section  describes  the  application  of  the  Hooke  and  Jeeves  algorithm 
to  a specific  control  problem. 


Review  of  Mathematical  Programming  Algorithms 

The  general  approach  to  solving  the  nonlinear  programming  problem 


min  J(a)  (1  big) 

is  to  proceed  from  a set  of  parameter  estimates  to  a better  set  of 

parameter  estimates  by  using  the  equation 

+ t]L  (C_3) 

The  scalar  step  length  t.  as  well  as  the  direction  vector  Aa  are  determined 

1 i 

by  the  strategy  used  in  devising  the  particular  method  under  consideration. 

Some  algorithms  choose  t^  by  performing  a one-dimensional  search,  such  as  those 
described  at  the  end  of  this  section,  along  the  Aa^  direction.  One  area  of 
current  research  favors  omitting  the  step  length  search  by  making  appropriate 
choices  for  Aa^,  for  example  see  [1,2].  Other  algorithms  [3, A]  select  the 
direction  of  search  and  the  step  length  simultaneously.  The  point  will 
be  accepted  as  the  desired  result  if  either  of  the  following  convergence 
criteria  are  met,  [5]  viz. 


, I |a.  - a._J  I < 


(C-4) 


where  c^  and  ^re  arbitrarily  small  and  l|*il  represents  the  Euclidian  norm. 

If  this  criteria  is  not  met,  the  algorithm  is  repeated. 

The  development  of  many  nonlinear  programming  algorithms  rely  heavily  on  the 
quadratic  approximation  of  the  objective  function  J(a)  provided  by  the  first 


three  terms  of  the  Taylor  series. 


J(  + Aa^)  = J(a^_j^)  + VJ^_jAa^+  -j  Aa^ 


(C-5) 


where  is  the  gradient  vector  and  is  the  real  symmetric  Hessian 

matrix.  Both  '7J . . and  H.  , are  evaluated  at  a. 

1-1  1-1  1-1 

Algorithms  are  classified  as  1.)  direct  search  methods,  2.)  methods  using 
first  partial  derivatives,  and  3.)  methods  using  second  partial  derivatives 
contingent  on  whether  the  algorithm  in  question  uses  no  terms,  the  first  two 
terms,  or  all  three  terms  respectively  of  equation  (5).  Since  the  calculation 
of  partial  derivatives  is  not  feasible  for  the  type  of  problems  being  considered 
here,  the  algorithms  discussed  will  be  limited  to  those  of  the  direct  search  type. 

The  development  of  direct  search  algorithms  has  been  guided  by  extensive 
experience  and  by  thinking  of  the  problem  as  that  of  following  valleys  down  the 
side  of  a mountain.  These  intuitively  developed  algorithms  obtain  the  direction 
vector  of  equation  (3)  by  observing  function  values  at  previous  points. 

A one-dimensional  search  in  the  Aa^  direction  is  used  to  determine  the  step 
length  t^  (see  equation  (3)). 

^2 


^1 

Figure:  Hooke  - Jeeves  Algorithm  for  n = 2 


One  simple,  but  very  effective,  algorithm  is  Hooke  and  Jeeves'  Pattern 
Search  [6].  This  algorithm  consists  of  a series  of  "exploratory  moves" 
followed  by  a "pattern  move,"  see  the  figure  above.  Beginning  at  a^,  a one- 
dimensional search  is  made  in  each  of  the  n coordinate  directions.  Thus,  for 
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A' 


these  exploratory  moves,  the  Aa^  of  equation  (3)  are  the  n coordinate  directions. 

The  selection  of  completes  the  first  set  of  exploratory  moves.  The  one-dimensional 
search  done  at  each  step  insures  that 

The  next  move  is  called  a pattern  move  and  is  made  by  choosing 

“n+1  = "^n  ^ (C-6) 

Since  '■'dually  evaluated,  it  may  be  the  case  that 

J(an+i)  > J(a„). 

A second  set  of  exploratory  moves  then  begins  at  and  proceeds  to  produce  the 

point  If 

a pattern  move  is  made  from  ci2n+l'  Otherwise,  one  returns  to  and  begins  a new 
set  of  exploratory  moves. 

The  pattern  moves  take  large  steps  along  valleys  while  exploratory  moves 
lead  back  down  to  the  valley  floor.  Some  programmers  modify  equation  (6)  so 
that  Un+l  i®  selected  as 

a,,  =a  +t(a  -a) 
n+1  n n n o 

where  t^  is  a stepJength  chosen  so 

Either  version  is  easv  to  program  and  requires  only  function  values.  Hooke  and 
Jeeves'  algorithm  is  particularly  attractive  for  use  in  minimizing  functions  having 
long  curved  valleys. 

Rosenbrock's  algorithm  [7]  subscribes  to  the  same  general  "valley  following" 
philosophy  as  docs  Hooke  and  Jeeves'  algorithm,  but  Rosenbrock  updates  the  set  of 
search  directions  by  adding  each  successful  new  search  direction  to  the  set  while 
removing  the  "oldest"  search  direction  from  the  set. 
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Given  a set  of  n mutually  orthogonal  directions  Rosenbrock's  method 

computes  a 02 from  an  initial  estimate  “o^y  using  equation  (3). 

A simple  linear  search  is  used  to  determine  t^^.  This  sequence  of  steps  is 
repeated  until  nonzero  values  are  found  for  all  t^,  i = 1,  2,  n. 

After  every  n iterations,  the  set  of  n search  directions  Aa^is  replaced 
by  the  set 

-J:  n — 

AUk  = T ti  Aa. 
i=k 

where  k = 1,  2,  n.  This  new  set  of  directions  is  orthogonalized  by  the 

familiar  Gram-Schmidt  orthonormalization  process  [8]  and  the  process  is  repeated. 

1 Hence,  the  method  aligns  the  first  search  direction  along  the  valley  which  has 

[ ■ just  produced  a favorable  reduction  in  the  value  of  the  objective  function.  A 

further  development  of  this  idea  has  been  pursued  by  Davies,  Swann,  and  Campey  | 

i 

[91.  ! 

i 

An  algorithm  by  M.J.D.  Powell  [10]  is  designed  to  search  in  such  a way  that 

the  directions  of  search  Aa^are  mutually  conjugate  to  the  Hessian  approximation 

of  inequality  (5),  viz. 

— T — 

Aoj^  H^  AUj  = 0 for  k / j and  k,  j i. 
vn\en  J(^  is  quadratic,  i.e.  inequality  (5)  becomes  an  equality,  it  can  be 
shown  [11]  that  the  minimum  will  be  found  in  n steps. 


The  iterative  procedure  for  Powell's  algorithm  is  given  below. 

1. )  For  i = 1,  2,  ...,  n,  compute 

“i  = ^i-1  + ^i  "^^i 
where  t^  is  chosen  such  that  J(a^) 

2. )  Set  A = max  (J(a.  ,)-J(a.)).  Let  k be  the  value  of  i which 

l<.i<n  ^ 

produces  this  maximum. 

3. )  Calculate  = J(2a^-ag)  and  define  = OCoiq)  and  J2  = J (cx^ ) . 


J 


algorithm  using  3s  the  starting  point. 

5.)  If  neither  condition  in  Step  4 holds,  replace  Aa^^with 

Act  = (ci-a„).  Pick  the  new  starting  point  a so  that 
k n 0 0 

— rfc  

(X-  = a + t,  Ao, 

0 n k K 


where  t has  been  calculated  to  insure 

J(a  ) < J(^  ) . 

0 — n 

Steps  1-5  are  repeated  until  tlie  termination  criteria  are  met  (see  (4)).  Each 
new  AOj^  produced  in  Stop  5 will  be  conjugate  to  those  previously  produced  by 
this  step.  The  initial  direction  vectors  Aa^ , i = 1,  2,  ...,  n are  usually 
chosen  as  the  coordinate  directions. 

In  certain  test  cases,  Powell  observed  that  his  algorithm  failed  to  compute 
a new  AOj^when  such  computation  was  needed  to  preserve  the  linear  indepen- 
dence of  the  current  search  directions.  Such  behavior  occurs  when  the  valley  of 
the  function  becomes  quite  narrow  and  elongated  and  Aoj^  repeatedly  fails  to 
be  updated  by  Step  5.  Zangwill  [12]  incorporated  periodic  coordinate  searches 
in  Powell's  algorithm  to  resolve  this  problem. 

While  there  are  many  other  good  direct  search  algorithms  available,  the 
ones  presented  here  represent  methods  which  are  easily  programmed  and  which 
require  a minimum  background  in  nonlinear  optimization.  The  reader  is  referred 
to  Himmelblau  [5]  and  to  Lessman  [11]  for  a complete  discussion  of  methods, 
programming  details,  and  examples.  We  conclude  this  section  with  a comment 
about  one-dimensional  search  algorithms. 

To  determine  the  scalar  t^  in  equation  (3)  any  algorithm  may  be  used  which 
produces  a scalar  t^  such  that 

d (a.  , + t . Aa.  ) < J(a  , ) . 

1-1  1 1 — i-1 

While  any  t^  satisfying  this  criteria  is  acceptable,  the  greater  the  reduction 
in  the  function  value,  the  better  is  the  performance  of  the  entire  algorithm. 
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Popular  one-dimensional  search  algorithms  include  the  Fibonacci  search  and  the 


quadratic  fit  algorithms.  These  algorithms  as  well  as  others  are  described  in 
}Iimmelblau  [5],  Lessman  [11],  and  Cooper  and  Steinberg  [13]. 
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Application 

The  example  cited  here  arises  from  the  authors'  study  [14]  of  a control  law 
presented  in  1973  by  Kim  and  Grider  [15].  This  law  was  designed  to  minimize 
both  the  miss  distance  and  the  body  attitude  angle  at  impact  for  an  air  to 
ground  missile  pursuing  a ground  target  moving  at  a constant  speed.  The  state 
equation  used  was: 


• 

■ 

Yd 

Yd 

^d 

- 

u cos  6 

''1 

• 

0 

Ku 

. 

where 


= the  distance  between  the  missile  and  the  target, 
projected  on  the  ground, 

e = the  body  attitude  angle  of  the  missile  (measured 
K,K^,W^  = constants 

and  u is  the  controller.  The  controller  u was  given  as 

u(t)  = [C  , C.,  C^] 
y y 0 


from  the  vertical) 


with 


Cy  = a^gK^n^/2)/A 

- ctjgK^n^/2)/A 

Cg  = (-aj^a2K  + 

2 2 2 3 2 2 A 

A = 02  + oija2K  12  + a^g  (2/3  + a^^g  K /12 


1 


wi’ere 


-K^cos0^/W^ 


= -H/(V*cos9) 


H = the  vertical  height  of  missile 


V = the  velocity  of  missile 
t = t ine 


tj.  = time  of  impact 


The  controller  was  designed  to  minimize  the  cost  functional: 

o o ^ f 


F = (t^)  + a^e  (tj)  + a^l  u“(t)dt  . 


Kim  and  Grider  reported  a miss  distance  of  0.04S  feet  with  ar  attitude  angle  at 
Impact  of  0.115  degrees.  They  used  the  follovrlng  initial  value  o obtain  these 
results : 


H = 10000  feet 


= 10000  feet 
d 


0 = 45  degrees 
V = 2000  ft. /second 


= 5 rad. /second 


Ki  = 1 

K = 0.0005 


= 3823 


,-5 


= 6.94  X 10  . 


The  authors  wished  to  produce  similar  results  for  miss  distance  and  attitude 
angle  at  impact  while  varying  H,  Y^,  0,  and  V.  The  control  law  was  also  modified 
so  that  the  attitude  angle  at  impact  0^  could  be  specified.  The  constants  , 

Kj , and  K were  to  remain  unchanged.  The  parameters  and  had  to  be  estimated 
to  achieve  the  desired  result. 

To  obtain  acceptable  values  for  and  the  folio-  ing  nonlinear  pro- 
gramming problem  was  formulated, 

min  J(^)  = Y^^(a)  + (0(a)-O^)^  (2  bis) 

where  values  of  Yj(a)  and  0(a)  would  be  determined  by  running  the  simulation  with 


HooKe  and  Jeeves  algorithm  was  selected  as  the  method  to  be 
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used  in  solving  the  problem,  since  any  algorithm  relying  on  derivative  information 
for  J(a)  had  to  be  excluded.  The  Table  gives  the  results  obtained  for  the  initial 
conditions  : 


H = 1000  feet 
Yj  = 5000  feet 
e = 85° 


V = 1095 


f t . /sec. 


The  values  of  and  K were  the  same  as  those  used  by  Kim  and  Grider. 


Initial 

Values 

Final 

Values 

“1 

3823.598 

5525.508 

“2 

0. 340E-4 

0.190E-6 

J (a) 

1520.600 

10.970 

miss  distance  (feet) 

36.950 

3.301 

attitude  impact  angle  (degrees) 

57.462 

45.270 

Table:  Computational  Results 


The  column  labeled  Initial  Values  gives  the  initial  choices  of  and 
'^2  as  well  as  the  resulting  objective  function  value,  the  miss  distance,  and 
the  attitude  impact  angle.  The  Final  Values  column  shows  the  improved  values 
of  and  02  obtained  after  repeated  applications  of  the  Hooke  and  Jeeves 
algorithm.  Note  that  the  final  attitude  impact  angle  was  45.270°,  just  0.27° 
over  the  desired  impact  angle  of  = 45°. 

Before  leaving  this  example,  a computational  note  is  in  order.  The  Final 
Values  reported  in  the  Table  were  achieved  by  executing  the  Hooke  and  Jeeves 

algorithm,  evaluating  the  results,  and  reexecuting  the  algorithm  using  the 
best  results  from  the  previous  run.  Tliis  series  of  steps  was  repeated  several 
times  before  the  Final  Values  were  obtained.  This  is  not  unusual  behavior  for 
any  algorithm  to  exhibit  since  the  choice  of  search  directions  and  step  lengths 
used  by  an  algorithm  may  cause  criteria  (4b)  to  be  satisfied  before  a minimum 
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value  of  the  objectivi'  function  is  obtained.  Restarting  the  algorithm  will 
usually  be  successful  in  the  further  refinement  of  the  parameters  being 
estimated. 

Conclusions 

Nonlinear  programming  algorithms  are  a valuable  tool  in  the  determination 
of  many  control  law  parameters.  This  paper  has  presented  a review  of  several 
direct  search  algorithms  and  an  example  of  how  these  algorithms  can  be  applied 
to  obtain  parameter  estimates. 

As  can  be  seen  in  the  control  problem  example,  the  problem  of  finding  optimal 

values  for  the  control  parameters  and  is  replaced  with  a mathematical 

programming  problem  ; however,  this  new  problem  still  has  hidden  in  it  two  unknovm 

search  pareimeters  t and  t . The  advantage  of  this  formulation  is  that  there 
12 

are  several  techniques  available  for  finding  t and  t as  discussed  in  the 

1 2 

paragraph  just  above  the  example. 

In  applying  the  algorithms,  the  approach  is  essentially  the  same.  Specify 
the  parameters  to  be  estimated  and  the  objective  function  to  be  optimized.  The 
nonlinear  programming  algorithm  then  uses  values  of  the  objective  function  at 
various  points  to  produce  improved  parameter  estimates.  The  process  is  repeated 
until  no  additional  improvement  can  be  made  in  parameter  values  or  until  the 
objective  function  reaches  a specified  value. 
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Appendix  D:  Houke-Jeeves  Algorithm  Listing 


REAL»8  CQUANT 

COMMON  NBASE,X,N,LA,K,KK,NPRNT,NTRy 
COMMON/CONSTR/ CQUANT 
EXTERNAL  COMPUT 

DIMENSION  XO(IO) ,X(10) ,XMAX(10) ,XMIN(10) 

NTRY=0 

NBASE=0 

READ(5, ’ 0000 )T0L,ALPH, BETA, DEL, LIM,LT,LSN,N,NPR NT 

10000  F0RMAT(4E12. 0,110, 414) 

READ (5, 10001 ) (X0(I ) ,XMAX(I ) ,XMIN(I),I=1,N) 

10001  F0RMAT(3E15. 0) 

INPUT  THETAO  FOR  KGCTRL  FUNCTION 
READ(5, 10001)  CQUANT 

DO  10  1=1 ,N 
0 X(I)=X0(I) 

LA=0 

5 CALL  PATTFN(COMPUT,  XMAX.XMIN,  LT , LIM , TOL , LSN , DEL, 

1 ALPH.BETA) 

READ(5, 10002, END=999)L, ALPH, BETA, DEL, LA 
0002  F0RMAT(4E12.0, II ) 

IF  (LA.EQ.9)  GO  TO  15 
IF  (LA.GT.O)  GO  TO  5 
999  STOP 
END 

SUBROUTINE  PATTRN ( COMPUT , XMAX,XMIN,  LT , LIM , TOL , LSN , 

1DEL, ALPH, BETA) 

COMMON  NBASE , X , N , LA , K , KK , NPRNT , NTRY 
DIMENSION  X( 10) ,XMAXC 10) ,XMIN( 10) 

DIMENSION  C( 100)  ,D( 100) 

LOGICAL  TYPE 

X IS  ARRAY  OF  INDEPENDENT  VARIABLES 

C IS  ARRAY  OF  INDEPENDENT  VARIABLES  AT  LAST  BASE  POINT 
XMAX  IS  ARRAY  OF  MAXIMUM  LIMITS  ON  X 

XMIN  IS  ARRAY  OF  MINIMUM  LIMITS  ON  X 

0 IS  ARRAY  OF  STEP  SIZES  FOR  X 
LA  IS  PRIMARY  BRANCHING  CONTROL 
= 1 FOR  INITIALIZATION 

= 2 FOR  INITIAL  MOVE  OF  X(K)  IN  EXPLORATORY  SEARCH 

= 3 for  REVERSE  MOVE  OF  X(K)  IN  EXPLORATORY  SEARCH 

= 4 FOR  PATTERN  MOVE 

= 5 FOR  INITIAL  MOVE  OF  X(K)  AFTER  PATTERN  MOVE 

= 6 FOR  REVERSE  MOVE  OF  X(K)  AFTER  PATTERN  MOVE 

= 7 FOR  BASE  POINT 

= 8 WHEN  SEARCH  IS  FINISHED 

K IS  INDEX  OF  X 

KK  IS  COUNTER  FOR  NO.  X,S  TESTED  SINCE  LAST  BASE  POINT 
N IS  NO.  OF  INDEPENDENT  VARIABLES 

DEL  IS  INITIAL  STEP  SIZE  CONTROL  = 0.01  FOR  0 INPUT 
LT  IS  CONTROL  ON  MAX  KK  BEFORE  BASE  POINT 
= N-1  FOR  0 INPUT 
= N FOR  INPUT  GREATER  THAN  N 
LIM  IS  MAX  NO  OF  MOVES  = 1.0E5  FOR  0 INPUT 

TOL  IS  BASE  POINT  TEST  TOLERANCE  AND  MIN  LIMIT  ON  STEP  SIZE 
= 1.0E-5  FOR  0 INPUT 
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C LSN  IS  CONTROL  ON  FUNCTION  EVALUATION  AT  BASE  POINT 
C EVALUATION  IS  DONE  IF  LSN.NE.O 

C ALPH  IS  RATIO  TO  INCREASE  D(K) 

C = 2.5  FOR  0 INPUT 
C BETA  IS  RATIO  TO  DECREASE  D(K) 

C = 1/3  FOR  0 INPUT 
TYPEr. FALSE. 

IF(LA.EQ.9)GO  TO  800 
LA  = 1 

100  NCT=0 

DO  14  L=1 ,N 

IF  (XMAX(L) .GE.XMIN(L))  GO  TO  10 
WRITE(6 ,2000)L 

2000  FORMAT(1HO,68HO  INPUT  DATA  ERROR.  LIMITS  REVERSED  FOR  INDEPENDE 
1NT  VARIABLE  NO.  ,14) 

LA  = 10 
GO  TO  500 

10  IF  (XMAX(L) .EQ.XMIN(L))  NCT=NCT+1 
IF  (X(L)-XMAX(L))  12,14,11 

11  X(L)=XMAX(L) 

GO  TO  14 

12  IF  (XMIN(L)-X(L))  14,14,13 

13  ;:(L)  = XMIN(L) 

14  CONTINUE 

IF  (NCT.LT.N)  GO  TO  15 
LA  = 1 

CALL  COMPUT(SN) 

WRITE(6,2010) 

2010  F0RMAT(1H0,47H0  EACH  PAIR  OF  UPPER  AND  LOWER  LIMITS  IS  EQUAL  / 

1 26H  NO  SEARCH  IS  POSSIBLE  ) 

LA  = 10 
GO  TO  500 

15  IF  (LT)  17,17,  16 

16  IF  (LT.GT.N)  LT=N 
GO  TO  20 

17  LT=N-1 

IF  (LT.LT.  1 ) LT=1 
20  IF  (LIM.LE.O)  LIM=1E5 

IF  (TOL.LE.O)  TOL=1.0E-5 

IF  (DEL.LE.O)  DELrO.01 

IF  (ALPH.LE.O)  ALPH=2.5 
IF  (BETA.LE.O)  BETA=1. 0/3.0 
800  DO  810  L = 1 ,N 

D(L)=(XMAX(L)-XMIN(L) )»DEL 
810  C(L)=X(L) 

WRITE(6, 3000)  (D(L),  L=1,N) 

3000  FORM AT ( ' 0$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$ ' / 

#'  INITIAL  STEP  SIZES'/'  ',8E15.7/  ' $$$$$$$$$$$$$$$$$$$$$$') 
NOFAILrO 
NPF  = 0 
NCT=1 
K = 1 
KK=1 
M1  = 1 
M2=1 

CALL  COMPUT(SN) 

SPrSN 
SC=SN 
LA  = 1 

GO  TO  500 
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110  TYPE=. FALSE. 

120  LA=2 

GO  TO  150 

130  IF  (.NOT. TYPE)  GO  TO  120 
140  LA=5 

150  IF  (D(K).EQ.O)  GO  TO  340 
X(K)=X(K)+D(K) 

160  IF  (X(K) .CT.XMAX(K) .OR.X(K) .LT.XMIN(K)) 

1 GOTO  (500,310,330,500,310,330,500,500) , LA 
GO  TO  850 

200  IF  (SN-SP)  201,310,310 

201  IF  (TYPE)  D(K)=D(K)»ALPH 
210  SPrSN 

NPF=0 
M1  = l 
M2=1 

220  K=K+1 

IF  (K.GT.N)  K=1 

222  IF  (LT.LE.  1 ) GO  TO  230 

223  IF  (KK.LT.LT)  GO  TO  224 
GO  TO  230 

224  KK=KK+1 
GO  TO  130 

230  IF  (SP+TOL»ABS(SC) .GE.SC)  GO  TO  234 

231  IF  ( TYPE. AND. (NPF.LT.5)  . OR . . NOT . TYPE ) G0T0232 
G0T0234 

232  LA=7 
NBASE=NBASE+1 
M1  = 1 

IF  (LSN)  850,520,850 

234  KK=KK+1 

IF  (KK-N)  130, 130,235 

235  N0FAIL=N0FAIL+1 

IF  (NOFAIL-15)280,500,500 

280  IF  (.NOT. TYPE)  G0T0281 

282  NPF=0 

DO  283  1=1 , N 

283  X(I)=C(I) 

GO  TO  284 

281  IF  (M1.GT.N)  GO  TO  300 

284  KK=1 
Ml  = l 
M2  = 1 
SP=SC 

GO  TO! 1 10 

300  WRITE(6,2020)SC 
GO  TO  500 

310  IF  (TYPE)  G0T0312 

311  LA=3 

GO  TO  313 

312  LA=6 

313  X(K)=X(K)-D(K)-D(K) 

GO  TO  160 

320  IF  (SN.GE.SP)  GOTO330 

321  D(K)=-D(K) 

GO  TO  210 

330  X(K)=X(K)+D(K) 

DX=TOL»ABS(X(K)) 

IF  (DX.LT. 1 .OE-30)  DX=1.0E-30 
332  D(K)=D(K)*BETA 


333 

IF  (ABS(D(K)) .GE.DX)  G0T0340 
D(K)=S1GN(DX,D(K)) 

340 

M1=MU1 

IF  ( .NOT. TYPE)  GO  TO  220 

342 

M2=M2+1 

343 

IF  (M2.LE.N)  GO  TO  220 

M2=1 

C 

NPF=NPF+1 

GO  TO  220 

END  MINIMUM  STEP  SIZE  TESTS  AND  PATTERN 

FAILURE  COUNT 

500 

CONTINUE 

2020 

F0RMAT(///5H  SN=,E15.7,5H  SP=,E15.7,5H 

SC=, E15.7,6H 

1 E15.7,/6H  TOL=,E15.7,8H  ALPHA= , E 15 . 7 , 7H  BETA=,E15.7/ 

18X,8H  TYPE  ,L1,3X,3H  N=,I3,3X,3H  K=,I3,3X,4H  KK=,I4,3X,4H  LA=, 
113,/  8X,4H  LT=,I3,3X,5H  LSN= , 1 3, 3X , 4H  M1  = ,I3,3X,4H  M2=,I3,3X, 

15H  NPF=,I3,/  8X,5H  NCT= , 16 , 3X , 5H  LIM=,  I7,3X,7H  NBASE= , 14 , 3X , 

18H  NOFAIL=, 13,//  3H  NO, 9X , 1HX, 18X, 1HC, 18X, 1HD, 16X, 4HXMAX, 15X, 
14HXMAX,/) 

2030  FORMAT  (I3,5E19.8) 

WRITE (6 , 2020 )3N, SP , SC , DEL , TOL , ALPH , BETA , TYPE , N , K , KK , LA , LT , LSN , M 1 , M 
12,  NPF,NCT,LIM,NBASE, NOFAIL 
DO  501  1=1 ,N 

501  WRITE(6,2030)  I , X ( I ) , C( I ) , D( I ) , XMAX (I ) , XMIN ( I ) 

C OUTPUT  BLOCK  FOR  LA  ERROR  ENTRY  AND  LIM  FINISH 

IF  (LA.EQ. 1)  GO  TO  110 

505  IF  (LA.GE.8)  G0TO900 

506  LA=8 
DO  507  1 = 1 , N 

507  X(I)=CCI) 

GO  TO  850 

510  IF  (LSN)  511,520,511 

511  SP=SN 
520  SC=SP 

LA=4 
KK  = 1 

DO  526  L = 1 ,N 
P = C(L) 

C(L)  = X(L) 

IF  ( (2»X(L)-P) .LE.XMAX(L))  G0T0523 

522  X(L)=XMAX(L) 

GO  TO  526 

523  IF( (2»X(L)-P) .GE.XMIN(L) ) G0T0525 

524  X(L)=XMIN(L) 

GO  TO  526 

525  X(L)=2»X(L)-P 

526  CONTINUE 

527  NOFAIL=0 
GO  TO  850 

530  SP=SN 

TYPE=.TRUE. 

GO  TO  140 

850  NCT=NCT+1 
IF(NCT-LIM)  852,851,851 

851  IF(LA-8)  500,852,500 

852  CALL  COMPUT(SN) 

C 

C IF  MOVE  SUCCESSFUL,  CHECK  HARD  CONSTRAINTS--ELSE  CONTINUE. 

C 

GO  TO  1000 

IF  (SP  .LT.  SN)  GO  TO  1000 
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IF  (ABS(ABS(CQUANT)-45. ) .LE.  5.0)  GO  TO  1000 
WRITE(6, 1002)  CQUANT,LA,NCT, (X(I4)  , 14  = 1, N) 

1002  FORMATCO',  50( ’//'),/'  HARD  CONSTRAINT  VIOLATED:  CQUANT  =’, 

%G9.4,  ' LA  = ',12,  'NCT  = ',15,/'  X=  ',12G9.4) 

WRITE(6, 1003)  (D(I4),  14=1, N) 

1003  FORMATC  ARRAY  OF  STEPLENGTHS : ’ / ' ',  10G11.4) 

C IF  CONSTRAINT  VIOLATED,  FAKE  INCREASE  IN  FCTN.  VALUE  AND  LET  ORIGINAL 
C CODE  SHORTEN  STEP  LENGTH. 

SN  = SP  + 1 .0 
C 

1000  GO  TO  (100,200,320,530,200,320,510,900,800) , LA 
900  RETURN 
END 

SUBROUTINE  COMPUT(Z) 

REAL  KGCTRL 

COMMON  NBASE,X,N,LA,K,KK,NPRNT,NTRY 
DIMENSION  X(10) 

C YY=  100.0*(X(2)-X(1 )*»2)«*2+(1-X(1 ))«»2 

C CALL  KIM-GRIDER  CONTROL  LAW 

YY=ABS(KGCTRL(X( 1 ) , X ( 2 ) , NBASE ) ) 

NTRY=NTRY+1 

IF  (LA.EQ.7)  NBASE=NBASE+1 
IF  (LA.EQ.1  .OR.  LA.GT.6  .OR.  NPRNT.NE.O) 
1WRITE(6,5)YY,LA,K,KK,NTRY,NBASE,(I,X(I) ,1=1 ,N) 

5 FORMAT(  4H0  SN,E15.7,3H  LA,I2,2H  K,I2,3H  KK,I2,5H  NTRY,I5, 

1 6H  NBASE, I5/(4(4H  X ( , 1 1 , 1H ) , E 1 5 . 7 ) ) ) 

Z=YY 

RETURN 

END 

. . INC  KGCTRL  DBLFCTN 
//GO.SYSIN  DD  * 

0.00001  1.5  0.050  0.01000  0500  322 

6199.992  6200.  0. 

.00002351592  .1  0. 

87.5 

/» 


/ 


t 
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Appendix  E:  Derivation  of  the  Three-State  Controller 


Problem:  Derive  a control  Law  of  the  form 

u = Cj^(t)Yj  + C2(t)Y^  + C2(t)e  (E-1) 

to  minimize  the  cost  functional 

J = Y^^(tj)  + Ye^(tp  + 6j^fu^(t)dt  (E-2) 

o 

• 

where  the  state  variables  Y , Y , 0 are  subject  to  the  dynamics 

d d 

Y = Y^  (E-3) 

d d 

Y = -(K  /W  )ub  , b = cos  6(t^)  (E-4) 

dll  t 

6 = K-  u . (E-5) 

a 

Solution : Using  the  technique  of  Lagrangian  multipliers,  define 
the  Hamiltonian  to  be 

2 ' 

H = 3'u  + \iY,  - X«K, bu/W,  + X~K  u . (E-6) 

Id  2 1 1 3 a 

Following  the  method  of  solution  as  outlined  in  [1],  in  order  for 
u to  be  the  optimal  controller, 

3H/3u  = 0 = 2Bu  - X„K,b/W,  + X„K  (E-7) 

2 1 1 2 a 

and  so 

u = [X^K^b/W^  - X3K^j/(2S)  . (E-8) 

The  controller  u then  is  determined  once  the  Lagrangian  multipliers 
are  known. 


Determination  of  X^ , X2,  X^ 

The  condition  that  they  must  satisfy  is 

3H/3X^  = -^i  . i = 1.2,3  (E-9) 

where 

= i^^^  state  , i = 1,2,3  . 
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Thus 


3H/3Xj^  = 3H/3Yj  = 0 = -^i  (E-10) 

3H/3X2  = 3H/3Yjj  = -X2  (E-11) 

SH/SX^  = aH/3e  =0  = . (E-12) 

Boundary  conditions  for  X^,  X^,  X^  are  given  by; 

X^(tj)  = 3u/3X.(t^)  , i = 1,2,3  . (E-13) 

Thus, 

Xi(tf)  = 2-Yj(t^)  (E-14) 

X2(t^)  = 0 (E-15) 

X3(t^)  = 2-Y0(t^)  . (E-16) 


Solving  the  differential  equation  (E-10)  and  using  condition 
(E-14) , we  get 


X3(t)  = 2-Yj(tf)  . 


(E-17) 


Equation  (E-11)  combined  with  Equation  (E-17)  yields 

\^(t)  = -2- Yj(tg)t  + c . (E-18) 

Boundary  Condition  (E-15)  implies 

X2(t)  = -2  Y^(t^)t  + 2-Y^(tpt^  . (E-19) 

For  X3,  Equation  (E-12)  combined  with  condition  (E-16)  gives 

X3(t)  = 2-Y0(tp  . (E-20) 


Hence,  the  control  u given  by  Equation  (E-8)  becomes 

u(t)  = [g-Y  (t  )(t-t  ) - K-  Ye(t^)]/B  (E-21) 

d t f a t 


where 

g = -Kj^b/W^  . (E-22) 

The  controller  can  now  be  determined  if  Y^(tj)  and  6(t^)  are 
known  in  closed  form. 
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Determination  of  ^ j and  6 ( t ^ ) 

Once  the  form  of  the  controller  has  been  determined  as  In 
Equation  (E-21) , we  can  return  to  the  original  system  of  differential 
equations  (E-3)  - (E-5)  and  solve  for  Yj(t),  e(t).  Equation  (E-4) 
becomes 


Y = gu  = g[gY  (t  )(t-t  ) - K-  Ye(t-)]/3 
d d r f a f 


(E-23) 


Integrating, 


Y.  = g[gY  (t  )(t-t  )^/2  - K-  Ye(t  )(t-t  ) + d ]/e 
d dff  affl 


(E-24) 


and  again, 


Y.(t)  = g[gY  (t  J(t-t  )3/6-K  • Y0(t^)(t-t^)2/2  + d,(t-t^)  + d 1/3  . (E-25) 

a dff  atf  lf2 


Also,  for  6 (t) , 


6 = K^[g-Y^(tj)(t-tj)  - K^-  Y0(tf)]/3 


e(t)  = K^[g*  Y^(t^.)  (t-t^)  /2  - Y0(t^)(t-t^)  + d^l/e 


(E-26) 


Now,  letting  t = tg  we  determine  d^,  d2,  d3  from  Equations 
(E-24),  (E-25),  (E-26).  Substituting  and  simplifying  yields: 


d = -(t  -t  ) g-Y  (t  )/2  + (t  -t  )Ka-Y0(t  ) + 6Y  (t  )/g 
1 of  df  of  f dt 

^ ^’'o”*'f^^^"^a  Y0(tj))/2 
+ (Vtf)(-6Y^(t,)/«)  + 3Y^(t^)/g 

d = (t  -t  )2(-g.Y  (t  ))/2  + (t  -t  )K*Y0(t  ) + 6e(t  )/K 
3 of  df  ofa  f oa 


(E-27) 


(E-28) 


(E-29) 


Using  d^,  d2,  d^  and  now  letting  t=t£,  we  can  write  down  two 
equations — two  unknowns;  Y^(t£)  and  e(t£). 

Yd(tf)  = g-d2/6 

Yd(tf)  = (t^-tj)^Yj(t^)g^/(3B)  + (t^-tj)^(-K^  Y0(tf)g)/ 

(26)  + (t  -t,)(-Y  (t^)  + Y (t  ) 
o t do  do 


(E-30) 


E-3 


I 

i 


e(t j = K d /e 

f a 3 

0(t,)  = (t  -t^)^(-gK  Y (t  J)/(2B)  + (t  -t.)K  ^Ye(t_)/B  + e(t  ) . (E-31) 

f of  adf  ofaf  o 


Solving  Two  Equations  - Two  Unknowns 

The  system  foi  ^^(t^),  0(tj)  is  (with  Q = t^-t j) ; 

Y.(t.)[l-g2fi^/(36)]  + 9(t^)[K  Ygi:^^/(26)]  = Y (t  ) - OT  (t  ) (E-32) 

df  fa  dodo 


Defining 


A E S'"  det  A 


we  obtain  the  following: 

+ fi^[2BY.(t„)K  ^Y  - e(t^)K  Yg6]/2}/A 

Q O a 0 3 

0(t  ) = {62e(t  ) - 6gK  Y.(t  )n^/2  + 
f o ado 

[3BgK  Y^(t  ) - 2g^6e(t  )]D^/6}/A  . 
ado  o 

Therefore,  returning  to  Equation  (E-21), 

u(t;t  ) = gY  (t Jfl/e  - K Ye(t^)/S, 
o dr  at 

and  substituting  Equations  (E-36) , (E-37)  and  simplifying,  yields 

u(t)  = Y (t)[-gBU  - gK  + gK  ^yn'^/2]/t^ 

d a a 

+ Y (t)[-gBD2  - gK  + K 2Ygii3/2]/A 

d a a 

+ 0(t)[K^.g^fi^/2  - KjB  - YK^g^52^/3]/A  . 


Y (t^)[gK  Q^/(2<^)]  + 0(tJ[l-K  = e(t  ) . 

d f a fa  o 

Using  Crammer's  Rule  to  solve,  we  calculate  the  determinant  of  the 
coefficient  matrix: 

det  A = (l/B^)[Yg^K  2fi^/12  + Bg^S2^/3  + Qy3K  ^ + B^]  . 

a a 


(E-33) 


(E-34) 


(E-35) 


(E-36) 


(E-37) 


(E-38) 


(E-39) 


i 
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Hence,  we  conclude  that 


2 2 

Ci(t)  = [-gfc(tf-t)  - gK^  Y(tf-t)  /2]/A 
C2(t)  = [-ge(tf-t)^  - gK^^Y(tj-t)/2]/A 
C3(t)  = [K^Yg^(tj-t)^/6  - K^yB]/A 


where 


and 


A = Yg\^(tj-t)^/12  + 3g^(tj,-t)^/3  + YBK^^(tf-t)  + 6^ 


g = -K^b/W^  . 


(E-40) 

(E-41) 

(E-A2) 

(E-43) 
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